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SUMMARY 


Pre-processors developed by AMA, Inc. to utilize and evaluate the 
relative performance of the NASA Space Shuttle tri-redundant Inertial 
Measurement Unit are documented in this report. Also, post-flight STS-1 
results are presented. The flight results (Section II) show that the relative 
IMU performance throughout the entire entry flight was within the expected 
accuracy. Comparisons are presented which show differences in the accum- 
ulated sensed velocitj’ changes as measured by the tri-redundant IMUs (in 
Mean Equator and Equinox of 1950. 0), differences in the equivalent ’’inertial" 
Euler angles as measured with respect to the M50 systerr. and finally, pre- 
liminaiy instrument calibrations determined relative to the ensemble average 
measurement set. Also, differences in the derived body axes rates and 
accelerations are presented. Because of the excellent performance of the 
IMUs during the STS-l entiy,the selection as to which particular IMU would 
best serve as the dynamic data source for entry reconstruction is arbitrary. 

Software functional descriptions, utilization, and sample job control 
language are presented as Section HI. Attached as Appendices A, B, C and 
D are listings for PRETM, PREVEL, ABSATT and CALIBRT, respectively. 
These prc^rams represent first level pre-processors necessary to edit the 
IMU data and permit selection of the best set of dynamic data to utilize for 
state prediction in the entry trajectory reconstmction process. PRETM 
edits the telemetry data and generates a differentiable file for PREIMU, the 
cubic spline processor. PREVEL and ABSATT generate plots for acceler- 
ometer and gyro performance comparisons. CALIBRT determines preliminary 
IMU instrument calibration parameters which include accelerometer biases, 
accelerometer scale factors, fixed and drifting misalignments. 



I. Introduction 


The measurements from the tri -redundant IMUs aboard the Space 
Shuttle, primary for navigation and flight control, offer considerable benefit 
for post-flight entry reconstruction and flight path analysis. The redundancy 
of measurements enhances the potential for obtaining contiguous data thi-ough- 
out the entire entry flight. Further, though time-homogenous measurements 
are limited to approximately 1 Hz, the data rate has been shown sufficient 
(Ref. 1) to utilize these data as a (fynamic data source (angular rates and 
accelerations) for state prediction in the deterministic integration algorithm. 
Pre-processors have been developed to utilize these data to provide "equivalent" 
3trapped-down measurements to satisfy the requirements of the entry trajectory 
estimation software (Ref. 2). Finally, these measurements potentially provide 
for an in situ calibration bench for the alternate dynamic data source, the 
Aerodynamic Coefficient Identification Package (ACIP). For the latter purpose 
it should be recognized that the IMU data rate can be a limiting factor. 

Before proceeding with any entry trajectory reconstruction activities, a 
selection process is required to determine the ’'best" dynamic data set for 
such purpose. Relative performance of the IMUs must be evaluated and, since 
some instrument calibrations may be required, some measure of the expected 
level of such calibrations needs be determined. In this report, relative com- 
parisons, preliminary calibrations, and software itilities to enable data editing 
and generate said results with the IMU measurements are presented. 
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n. STS-l Post- flight results 




II. 1 Accelerometer comparisons 

Accelerometer performance of the tri-redundant IMUs can most 
readily be made in the fundamental reference frame, M50. However, one 
cannot completely uncouple gyro accuracies from such analysis since actual 
platform measurements are rotated to the M50 frame on-board using fixed 
REFSMAT matrices which relate each platform to the inertial system (this 
assumes perfect knowledge of the platform orientation). As such, imbedded 
in such comparisons are initial misalignment and both fixed as well as g- 
sensitive gyro drifts. 

In this evaluation, each velocity counter was rebalanced (nulled) at the 
initial epoch assumed, namely, t = 17^42™3ofo (63750 sec) on DCY 104. 
Comparisons were made thereafter directly in the accumulated sensed M50 
components for the respective IMUs. Also, various combinations of IMU 
measurements were formed, e. g. , averages and mid-value selects. Total 
magnitude velocity comparisons were also made. Results are presented as 
figures 1-4 , inclusive. Figures 1 through 3 show M50 X, Y, Z component 
differences. Each figure is ordered to show IMUl comparisons versus 
IMU2, IMUS, the average component and the mid-value measurement. The 
remaining differences for IMU2 and IMUS are included to complete each 
plot. Computed statistics, i. e. , means and standard deviations, for each 
difference are designated thereon. Component differences of as much as 
SO fps can be seen in the X direction (viz. , IMU2 - IMUS), SO ^s in the Y 
direction (viz. , IMUl - mid-value), and 50 ^s in the Z direction (viz. , IMUl - 
IMU2). Magnitude comparisons (Fig. 4) show tliat the total sensed change per 
IMU differs by, at most, S fps. This seemingly indicates that accelerometer 
scale factors for each of the IMUs were nearly perfect since magnitude differ- 
ences are considerably smaller than component differences. However, with 
this information alone one cannot ascertain the extent of the contribution to 
the component differences from either fixed or drifting misalignments. 
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The following table indicates the percentage of occurrences each IMU 
was selected as the mid-value throughout the entire entry time frame. 


IMU 


Component 

1 

2 

3 

X 

43.1% 

22.4% 

34.5% 

Y 

5.8% 

61.5% 

32.7% 

Z 

22.9% 

51 , 6 % 

25.5% 
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II. 2 Gyro Comparisons 


Gyro performance can be Independently evaluated by comparing absolute 
attitude differences as suggested by the three independent systems. The ab- 
solute attitude differences were formulated by deriving equivalent Euler angles 
which describe the spacecraft orientation with respect to the inertial M50 
system. Keeping in mind that each IMU outputs quaternions which define plat- 
form to outer roll orientation, two fixed transformations, outer roll to Nav 
base and Nav base to body, combined with the appropriate REFSMAT, define 
the total transformation between the body and inertial frames. The Euler angles 
can then be computed from the direction cosines. For this analysis, an ordered 
Eulerian rotational sequence (-Z, -Y, -X) was assumed. The angles are de- 
fined herein as , © , and ® . 

Differences in 'I', 6, and ^ for the various IMUs are presented as 
Figures 5-7, respectively. Again, all IMUl comparisons are plotted first 
and the remaining differences for IMJ2 and IMUS are shown. Differences 
versus averages and mid-values are also included. For the most part, all 
differences are well within 0?1 (though much grciter than the Indicated resolver 
noise) throughout the entire entry ftight. Maximcni differences are seen to be 
0?17 for (viz. , IMU2 - IMU3), 0?14 for © viz. , IMU2-I Vi and 0?17 for 
^ (viz. , IMUl - IMU2). Associated statistics for each plot are as shown. 

Percentage occurrences for which each IMU was selected as the mid- value 
for each compx>nent are given in the following table: 

imj 

Euler Angle 1 2 3 



15. G% 

40.5% 

43. 9% 

e 

29.2% 

58.2% 

12. 6% 


21.2% 

37.2% 

41.6% 


-11 



























A deg 


IMU2 - IMU3 
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II. 3 Derived Body Axis Comparisons 


The results of the previous two sub-sections showed comparisons 

between the three IMUs in a common reference (M50) though the Euler 

angle data were derived relative to same. Use of the IMU in the entry 

reconstruction process requires equivalent body axis data for the "strapped- 

down" deterministic integration formulation. Methods incorporated to enable 

such derived body axis information using IMU measurements are discussed 

m Eef. 1. In summary, cubic spline methods are incorporated which fit the 

measured E from any of the IMUs. Differentiation yields an accel- 

M50 

eration profile which can be expressed in the platform axis and thus, space- 
craft linear accelerations in the body axes. Also, an equivalent Euler angle 
set is determined from the platform to outer roll gimbal quaternions (as 
measured) and the two fixed transformations which relate outer roll to the 
spacecraft body axis. Similarly, these Euler angles are cubic spline fit and 
differentiated to yield Euler angle rates. These rates are used to determine 
spacecraft rates. 

Using the above formulation, body axes data were derived. These data 
were generated at the nominal IMU down-list rate (~1 Hz). Figures 8, 9, and 
10 show derived body axis differences between IMUl and IMU2, IMUl and 
IMUS, and IMU2 and IMUS, respectively. Angular rate and linear acceleration 
differences are plotted . Computed mean differences and standard deviations 
are indicated thereon for each body axis component. No major differences are 
indicated. The largest mean error in any angular rate component is 7E-5 deg/ 
sec, i. e. , 0. 25 deg/hr, which though small, is essentially an order of magni- 
tude larger than the expected value based on instrument specifications. The 

largest mean error in any of the linear acceleration components is ~ 0. 006 

2 

ft/sec or ~ 190 ^ g's. The specified accuracy is on the order of 50 ^ g’s. 

It is noted that differences in derived body axis quantities cannot (and should not) 
be compared versus expected platform accuracies , Considerable processing 
is required to obtain body axis data which can distort one's perspective as to 
IMU performance. However, the entry reconstruction software utilizes the 
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IMU data in the "strapped down" state prediction algorithm. Therefore bo(fy 
axis differences as presented in this Section are quite relevant and, most 
probably, represent the magnitude of calibrations one would expect from 
formal estimates in ENTREE eventhough such calibrations are modelled in 
the platform frame. A truer representation of STS-1 IMU accuracies is 
presented in the next Section. 
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Fig. 8 Derived body axes rate and acceleration comparisons, IMUl - IMU2 
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Fig. 9 Derived body axes rate and acceleration comparisons, IMUl - IMU3 
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Fig. 10 Derived body axes rate and acceleration comparisons, IMU2 - iMU3 



n. 4 Preliminary Calibrations 
II. 4. 1 Discussion 


Certainly some instrument calibrations ai’e to be e^qpected. During 
the entry reconstruction process it is most probably required to determine 
some calibrations tor the IMUs by including certain terms as solution par- 
ameters in the estimation algorithms. However, using the accumulated M50 
sensed velocity changes it is possible to define preliminary coefficients which 
can sriTve to either assist in selection of a particular parameter of importance 
or scope the extent of any required calibrations. It must be noted however that 
such determinations of preliminary calibrations are somewhat arbitrary since 
they must be based on an a; sumption as to v/hlch IMU, or combinations thereof, 
best represent the truth. hus, any formally determined instrument calibrations 
in the more rigorous entry reconstruction process, i.e. , during ENTREE pro- 
cessing, may well disagree with such preliminary estimates of instrument per- 
formance. In truth, ENTREE-detemined instrumont parauieters could be 
aliased by other unknown, unmodelled effects and represent equivalent calibra- 
tions fr I* the particular data processing arc utilized. However, the magnltud':, 
of the ENTREE-derived calibrations can be tested for reasonableness by com- 
paring wit'' the preliminary values (the stability of the ENTREE estimates can 
be indicated by the corresponding formal uncertainty su^ested therein but, in 
actuality, must be determined from the usual complement of estimation results 
for various data arcs and solution parameters incorjwrated). Further, the pre- 
liminary calibrations can provide insight as to which instrument parameters 
should be included in the cuqsanded ENl’REL estimation parameter list, though 
again, the accuracy with which the particular selected parameter is determinable 
resides within ENTREE. 

Even with the preceding "qaalifying" remarks, it is useful to determine 
preliminary instrument calibrations. The error model incorporated is as fol- 
lows (Note the assunqition that there are three independent gyros per platform 
rather than the actual cemfiguration that employs only two): 
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where: R is the REFSMAT matrix, 

is the selected observation vector (3 vector), 

MoO 

Sj scale factor coefficients, nominally 1, 0 

bj accelerometer bias terms, nominally 0. 0 

and total misalignment about the respective sub-scripted 

axes comprised of a fixed and drifting component, i. e. , 

o 

No g-sensitive drift terms were incorporated. 

There are twelve(12) parameters per IMU in the adopted model. The 
selected observable is chosen from one of eight potential V_ triplets. These 
e^ht (8) rqiresent individual IMU measuremaits (3), average measurements 
of any two (3), ensemble average measurements (1), and mid-value selected 
measurements (1). The selected triplet is expanded as a nine(9) vector obser- 
vable which corresponds to, equivalently, what each of the three IMUs would 
have measured assuming the selected triplet were exact. The expansion 

is nominally done using the individual REFSMAT matrices. Instrument cali- 
brations are determined, therefore, to minimize the sum-of- squares of the 
observation residuals in the platform axes. A weighted least squares filter is 
utilized. 

m.4.2 Results 

Preliminary IMU calibrations are presented in Table I. All eight 

V..-.. set of observables were selected for these determinations. Units utilized on 
M50 

Table I have been converted to those more commonly used by IMU investigators. 
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For reference, specified accuracy levels (1 C) arc approximately: 


50^ g 

0.022 deg/hr 
80 sec 

100 ppm 

and 0.025 deg/hr /g 


accelerometer bias 

platform drift bias 

platform misalignments (assuming 
star tracker alignment oii-orbit) 

accelerometer scale factor 

g-sensitlve gyro drift 


Shown on Table I are accelerometer scale factors , accelerometer biases, 
initial misalignments, and fixed drifts determined for each IMU based on the 
eight potential fiducial referenc'is. Null determlm'tions for each IMU when that 
particular IMU was chosen for calibrations are seen thereon. Table II shows 
a measure of the fit to the selectsd observibles in terms of pre-and post cal 
means and a's. 

It can be seen in Table I that the outliers, for the most part, in each 

determination are obtained when the mid-value observables were selected. 

M50 

Table n suggests that the fits to this measurement set are not as good, viz. , the 
post-cal ff's. This is an expected result since the nahire of such an observable 
is quite unique. Over some of the interval a particular IMU Is exactly the mid- 
value measurement which would imply null corrections. Throughout the remainder 
of the interval pre-cal residuals exist which require calibrations that are to the 
contrary. 

Generally speaking, again referring to Table I, the determined acceler- 
omester blares are less than i the expected level. I'Urther, neglecting determina- 
tions cast versus the mid-value measurements, scale factors are, at most, 1.2 
times the specified level. Initial misalignments do exhibit larger than expected 
values (as much as 4 to 5 times greater) though many determinations are less 
than la. For the most part, the fixed drift terms do exceed the specified level. 
The simple model aciopted herein would, however, absorb g-sensitlve drifts in 
both the initial alignment and fixed drift parameters. 

Four columns of Table I are composite determinations from ^ ensemble 
values presented in the first eight (8) columns. Mean calibrations and icvar- 
iations of same are presented for all eight sets. In two of these columns 
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are sin.ilar composite determinations neglecting the mid- value determinations. 
Both sets of composite determinations show accelerometer biases less than 
10 /i g ( ± 7) which compares to the actual flight expectation since on-board cal- 
ibrations were performed prior to the STS-1 re-entry. Again, neglecting the 
mid-value contributions, scale-factor determinations are less than 1 (±j ff); 

initial alignments are within 2 a (± l.Tcr). Even neglecting the mid- value 
contributions, fixed drift terms are as much as 4a in the composite deter- 
minations with ± 2a variations. 

Residuals are presented as Figures 11, 12, 13 for IMUl, IMU2, and 

IMU3, respectively, for the results based on the ensemble average obser- 

M50 

vables. Uncalibrated (based on nominal instrument parameters) and calibrated 
(based on updated instrument parameters) residuals are plotted. Mean and sigma 
computed for each plot are shown thereon. There is still signal remaining in 
the calibrated residuals which suggests the need to adopt, additional model par- 
ameters. As pointed out previorsly g-sensitive drift coefficients would be 
potential candidates, particularly in view of the fact that the simpler model 
(assuming fixed drift) }delds coefficients which, on a relative basis, would 
appear the most out of spec. Consideration for an expanded model, however, 
must be weighted against the somewhat arbitrary observable selection (required) 
from which any calibrations can be determined. 

n. 5 STS-1 IMU Performance Summary 

Though these preliminary calibrations cannot be taken as absolutes it is 
quite apparent that the IMU performance was essentially as expected. Selection 
of the best IMU for post-flight entry reconstruction is somewhat arbitrary. No 
real critical choice is suggested by the comparisons and calibrations presented 
herein. 
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Fig. 11 IMUl residual plots 
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Fig. 13 IMU3 residual plots 
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in. Software Descriptions 


m.l PRETM 

m. 1. 1 Functional description 

PRETM (see Appendix A for software listing) represents the first 

level of IMU processing, the main function of which is to generate an edited 

file of tri-redundant IMU quatemion and A V_,_„ measurements for processing 

M50 

in the PREIMU routine (Ref. 1)' ^ Editing is required to eliminate blunder 
points to assure the input file for PREIMU is differentiable. Data gap detec- 
tion is also performed. 

Editing performed is basically first difference comparisons of successive 
components to assure that such differences are within a specified input tolerance. 
Further, the quaternions are tested for orthonormalily. Finally, selected data 
not otherwise identified as bad by simple first difference tests can be rejected 
by user input. Also, to insure differentiability, the sense of the quaternions 
are tested and "flipped" if appropriate. 

m. 1.2 File interfaces 
a. Input file 

The input file (TAPES) corresponds to the NASA JSC/TRW 
Telemetiy tape as documented in their ICD, specifically, OFT Ascent/Descent 
Auxiliary Data Products Program Input/Output Interface Control Document 
79.6435. 14-019 (revised October 1, 1979). This fj’e is also defined in Ref. 3 
as published by the LaRC OEX Data Manager. As received from LaRC this 
file contains six files ordered as VM50 for IMUs 1 through 3 and quaternions 
from IMUs 1 through 3, respectively . This file is in a standard TIFT^^^ format 
with a header record written as the first record on each file. For input pur- 
poses to PRETM, this multi-file file is reordered using system Job control 


For STS-1 Oibiter Instrumentation data were received prior to the planned 
interface T/M tape from JSC/TRW which required development of another 
utility, PREOI, to provide an iiq>ut file for PRETM. PREOI is considered 
auxiliary software to the IMU data processing flow and aii such is not documented 
herein. 

( 2 ) 

'Time history Interface File Tape 
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language (JCL) to provide quaternion, VM50 ordering for each of the IMUs. 
Figure 14 shows sample JCL required to execute the software. Notation 
thereon shows the file manipulation required to obtain the properly ordered 
input file. 

b. Output files 

Apart from hard-copy printout two output files are generated. 
The first file (TAPE9) is the necessary input file for PREIMU and consists 
of eight (8) records per IMU. The first seven(7) records contain the IMU 
identifier, the number of records (N.) for each measurement, and the corres- 
ponding array of times and measurements, viz: 

Record 

1 IMU, , (t^(i), Q^(i), i = 1, N^) 

2 IMU, Ng , (tgCi), Q2(i). i = 1, N^) 

3 IMU, Ng , (tg(i), Qg(i), i = 1, Ng) 

4 BVIU, , (t^(i), Q^(i), i = 1, N^) 

5 IMU, Ng , (tg(i), V^(i), i = 1. Ng) 

6 IMU, Ng , (tg(i), Vy(i), i = 1, Ng) 

7 IMU, , (t^(i), V^(i), i = 1, N^) 

where IMU = 1, 2, or 3 and the N's and actual time arrays are, in 
general, not identical due to editing. 

The eighth record is simply the number, M , and corresponding time 
array which would correspond to a contiguous time array for PREIMU to 
fill in any missing (or edited) quaternion elements to complete the required 
set of four, i. e. , 

Record 

8 M, (t^gj(i), i = 1, M) 

Noted on Figure 14 is the JCL which saves this file on a physical reel 
for PREIMU processing. 


- 33 - 


A second output file (TAPEIO) is written which summarizes the relevant 
information in the generation of the PREIMU file. This file can be saved, 
e.g. , see Fig. 14, to provide quick review of the pre-processing results. A 
partial listing of this summary file is presented as Figure 15 for IMUl data 
processing, i. e. , from the first two files on the T/M tape. 

Written on the summary file are: 

(1) a summary of the user inputs, 

(2) headers as read from the input file (TAPES), 

(3) the first ten(lO) data records of each file, 

(4) a summarj'^ of the file contents of TAPE9 which is generated for 
PREIMU 

and (5) the number of times the quaternions were "flipped" for differen- 
tiability. 

This information is repeated for each IMU. 
m. 1.3 User Inputs 

Inputs are accomplished via NAMELIST/INPT/. Variables and 
default values are defined as follows: 


NAME 

Im 

Dimension 

Description 

Units 

Default 

TOLN 

real 

1 

criterion for orthonor- 
mality test, i. e. , ortho- 
normal within input 
tolerance 

N/A 

. 00001 

TOLQ 

real 

1 

tolerance for 1st differ- 
ence test on quaternion 
components 

N/A 

1.0 

TOLV 

real 

1 

tolerance for 1st diffei^ 

ence test on com- 

^ M50 

ponents 

fys 

100.0 

TSTART 

real 

1 

Start time for file 
generation (TAPE9) 

seconds 
of DOY 

0.0 

TEND 

real 

1 

stop time for file 
generation (TAPE9) 

seconds 
of DOY 

1.E8 
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NAME 


Dimension 

Description 

Units 

Default 

TOLVX 

real 

1 

tolerance on 
component magnitude 
test 

ft/sec 

I.EIO 

NDX 

integer 

(400,7,3) 

(3) 

input array (by index' ' 
number, measurement 
and IMU number for 
selected data rejection 

N/A 

8400*0 

DOY 

real 

1 

day of year extracted 
from times on input 
file 

days 

0. 

raiAss 

real 

1 

time bias between 
station and spacecraft 
clocks 

seconds 

0. 


m. 1.4 Outputs 

Besides the previously mentioned output files, the software generates 

an input data summary, defines the edit code utilized, and generates a complete 

listing of all data within the specified time span (TSTART <t< TEND). The hard 

copy printout is column-formatted to show time (referenced as seconds of the current 
(4) 

DOY), flag' measured components (four(4) for quaternions, three(3) for 
Vm 5 q)» record counter, gap indication column, time spacing ( At) between 
successive points, 1st difference in respective components, and an edit column. 
Figure 16 shows the edit keys as utilized internally and written in the appropri- 
ate column. Gaps are denoted as ** in the gap column and the At column 
provides immediate indication of the extent of the gap. Information written to 
the summary file (TAPEIO) is also written as hardcopy output. 

(3) 

'This array can only be established after at least one initial pass through the 
input data file. Points not otherwise rejected can then be isolated if required. 

The index number corresponds to a running reed'd counter (from 1 to NMAX) 
which is referenced to the first point on the input file, independent of TSTART 
or TEND. 

(4) 

This variable is constant for a given file and corresponds to the following: 

1.0 Vj ^50 measurements for IMUl 

2. 0 Vjj| 5 Q measurements for IMU2 

3-0 Vj {50 measurements for IMU3 

4. 0 Quaternion measurements for IMUl 

5. 0 Quaternion measurements for IMU2 

6.0 Quaternion measurements for IMU3 
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/JOB 

/NOSEQ 

kEll1,T1500,Crl270000. 

USER.274885C. 

tiET.PRETM. 

FTN,I=PRE7n,rL=20000. 

VSN.TAPE90=NN0733. 

LABEL,TAPE90,NT,D=PE,F=I,P0=R,R. 

C0PYEI,TAPE90,TAPEB0. 

REUIND,TAPE80,TAPE90. 

RETURN, TAPE90. 

UNLOAD, 7APE90. 
C0PYBR,TAPE80.DUN,3. 
COFYBR,TAPE80,TAPE8. 
REUIND,TAPE80. 

C0PYBR,TAPE80, TAPES. 
REUIND.TAPE80. 
C0PYBR,TAPE80,DUN,4. 
C0PYBR,TAPE80, TAPES. 
REU1ND.TAPE80. 

C0PYBR,TAPE80.DUN. ) 
C0PYBR,7APE8O. TAPES. 

REWIND. TAPE80. 
C0PYBR,TAPE80,DUN.5. 
C0PYBR.TAPE80, TAPES. 

REWIND, TAPE80. 
C0PYBR,TAPE80,DUf1,2. 
C0PYBR.TAPE80, TAPES. 

REWIND, TAPE80, TAPES. > 

RETURN. TAPE80. 

RETURN. DUN. 

LGO. 

REWIND, TAPE9. 

CATALOG. TAPE9. 

REWIND, TAPE9. 

VSN,TAPE90=NY1010. 

LABEL. TAPE90. NT, D=PE.F = I.PO = U.U. 
C0PYEI.TAPE9,TAPE90. 

REWIND, TAPE9.7APE90, 

CATALOG, TAPE90. 

REWIND, 7APE90. 

RETURN, TAPE9.TAPE90. 

UNLOAD. TAPE90. 

REWIND, TAPES. 

CATALOG. TAPES. 

REWIND, TAPE10. 

REPLACE, TAPE10=TNSUM. 
DAYFILE.THGOOD. 

REPLACE. TNGOOD. 

EXIT. 

STATUS, F. 

DAYFILE.TNBAD. 

REPLACE, TNBAD. 


BIN63F FINDLAY 

ORIGINAL PAGE IS 
OF POOR QUALITY 


Input TIFT file of T/M daia 


Re-ordering as: 


Q 

IMUl 

V 

M50 

IMUl 

Q 

IMU2 

V 

M50 

IMU2 

Q 

IMU3 

V 

M50 

IMU3 




Saves processed file for 
PREIMU input 




} 


Saves summary file 


/EOR 

lINPT 

TSTART=2365A4. .TEND=238936., 
D0Y=2. ,TBIASS=0.007, 

T0LV=1 .E50. 


«END 

/EOR 

/EOF 


User ii^uts 


Figure 14 Sample JCL for PRETM execution 
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Figure 15 Sample summary file (TAPEIO) from PRETM 
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Figure 15 (continued) 



Code 

1 

2 

3 

4 

5 

6 

7 

8 
9 

blank 


IQj(I) - Qja-l)l>'TOLQ or|vM50^(I) - VM50^(I-1)I > TOLV or 
|VM50^(I)| > TOLVX 

iQgCI) ■ Q2(I-l)l>TOLyQor|vM50^(I) - VM50^(I-1)| > TOLV or 
|vM50y(I)| > TOLVX 

Iq-(I) - Q,a-l)l> TOLQ or |VM50 (I) " VM50 (I-l)| > TOLV or 
o 3 z z 

|VM50^(I)| > TOLVX 
IQ4W -Q4(i-1)|>'tolq 


ii.o-yir 


Q(I)^|>TOLN 
Qj(I) or VM50^(I) rejected by ii^ut in NDX 

Q«U) or VM50 (I) rejected by input in NDX 

2 y 

Q-(I) or VM50 (I) rejected by input in NDX 

3 Z 

Q^(I) rejected by input in NDX array 


array 

array 

array 


No editing required 


rig\u*e 16 Definition of PRETTd edit codes 
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Iim •, 


in. 2 PREVEL 

in. 2. 1 Fanctional description 

Attached as Appendix B is a source listing of PREVEL. PREVEL 
generates velocity comparisons for the various IMUs. Generated are 
comr.t>nent comparisons, total magnitude comparisons, mid-value selection 
coinputation^j and associsted comparisons, ensemble average computations and 
comparisonr, and finally, though the results are not reported herein, dual IMU 
averaging and comparisons. All such differences are written to a special TIFT 
file for plotting pur poses. A file of "pseudo" observations in a TIPT format is 
also generate > be ased as input to CALEBRT (see Section in.4). 

As indicated earlier, each component is nulled initially and this initial value 
is extracted thereafter to yield changes in the data over the interval. 

Some editing is done to eliminate blimder points. 

m. 2. 2 File interfaces 

a. Input file 

The same JSC/TRW T/M formatted tape as discussed in Section 
m. 1. 2 is the required file for PREVEL. Only the first three(3) files are neces- 
saiy since they contain data for the respective IMUs . JCL to obtain these 

data is shown in Figure 17. Each file is read as a separate input file, i. e. , 
TAPES (IMUl), f APE9(IMU2), and TAPEIO (IMU3). 

b. Output files 

Two(2) output files are generated. The first file (TAPE12) is 
a TIFT formatted file containing all the possible component and magnitude 
differences, i. e. , a total of seventy-six (76) differences are written at each 
time. This file is plotted using the LaRC QUIKPLT utility developed by 
SDC. Perusal of the software listii^ in Appendix B for a precise definition 
of all differences generated is recommended. 
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A second output file, TAPEll, is generated. This file contains ?. time 
ordered file of "pseudo" observables for the CALIBRT utilitj'. Potential 
observables written are: 

(1) measurements from each IMU 

(2) dual, averages, i.e. , a>’^erage of IMUs 1 and 2, IMUs 1 and 3, 
and IIvIUs 2 and 3, 

(3) ensemble average components, 

and (4) selected mid- value components. 

As shown in Figure 17, this file is saved to a physical reel to be used 
in the generation of preliminaiy calibration. 

m. 2. 3 User inputs 

A namelist input (NAMELIST/INPT/) is provided. Input variables are 
defined as follows: 


NAME 


Dimension 

Description 

Units 

Default 

TTOL 

real 

1 

Time tolerance to assure 
all IMU datf valid at same 
time 

seconds 

0.1 

VTOL 

real 

1 

Velocity component re- 
jection criterion for 

^s 

I.EIO 


blunder point detection 
and elimination 


DVTOL 

real 

1 

First difference re- 
jection criterion for 
blunder point rejection 

fps 

100.0 

■reTART 

real 

1 

Start time for gener- 
ation of differences and 
pseudo observation files 

seconds 

0.0 

TEND 

real 

•s 

X 

Stop time for above file 
generation 

seconds 

1.E8 

TEPOCH 

real 

1 

Epoch (reference) time 
desired, i. e. , time 
treated as zero from 
TEPOCH 

seconds 

0.0 
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m.2.4 Outputs 


The most relevant outputs are the two files previously discussed, more 
specifically, QUIKPLTS of the computed differences and, after CALIBRT 
execution, estimates of preliminary instrument calibrations. Hardcopy out- 
put generated is minimal. The first ten(lO) time points are printed to show 
IMU component measurements, dual averages, ensemble average, and in- 
dication as to number of consecutive times each IMU component was selected 
as the mid-value measurement. Additional output generated presents the 
total number of records written ( TSTART < t < TEND) and a summaiy of the 
total number of times each IMU was selected as the mid-value by component. 
Finally, statistics (mean and standard deviations) are presented for each dif- 
ference generated. 
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OWGINAL PAGE !S 


/JOB 

/NOSEQ 

PREIMUC.T1000,CM200000. 

USER,274885C. 

CHARGE, ■MB,LRC. 

GET.PREVEL. 

FTN.I=PREyEL.R. 
ySN.TAPE80=NY1001 . 

LABEL, TAPE80. NT. D=PE,F=I,PO=R,R. 
C0PYBR.TAPE80JAPE8. 
C0PYBR.TAPE80.TAPE9. 
C0PYBR,TAPE80,TAPE10. 

REWIND, TAPE80, TAPES, TAPE?, TAPE! 0. 
RETURN. TAPE80. 

UNL0AD.TAPE80. 

LDSET,PRESET=IND£F. 

LGO. 

REWIND, TAPE12,TAPE11. 

GET.QUIKPLT/UN=149H1C. 

CALL,QUIKPLT(TAPE1=TAPE12) 

REWIND. SAUPLT. 

PL0T.CALP0ST,11 (Xh = 0.5,Yfi = 0.5) 
REWIND. TAPE1 1. 

USN,TAPE90=NY1016. 

LABEL. TAPE90, NT, D = PE,F = I,PO=U,U. 
C0PYEI.TAPE11 ,TAPE90. 
REWIND.TAPE11 .TAPE90. 

RETURN, TAPE1 1 .TAPE90. 

UNLOAD. TAPE90. 

DAYFILE,PCGUOD. 

REPLACE, PLGOOD. 

EXIT. 




> 


BIN63NC MCCONNELL 


gets first three(3) files of 
JSC/TM tape as TAPES (V^^q, IMUl), 
TAPE9(Vj^g^,IMU2), and 
TAPE10(V , IMU3) 


plots differences 


saves "pseudo" observable file for CALIBRT 


DAYFILE.PCGOOF. 

REPLACE. PCGOOF. 

/EOR 

$INPT 

TSTART = 0.. TEP0CH-. 904920371 807E7,TEND = 1 .Ell , 
DVTOL^200. . 
tEND 
/EOR 
/EOF 

EOI ENCOUNTERED. 

/ 


User inputs 


Figure 17 Sample JCL for PREVEL execution 
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m.3 ABSATT 


III. 3. 1 Functional description 

ABSATT, the source for which is attached as Appendix C, generates 
"absolute" attitude comparisons as suggested by the tri-redundant IMU measure- 
ments. Equivalent Euler angles relating spacecraft to the inertial M50 system 
are computed and differences are formed for plotting purposes. Comparisons 
are also generated (by component) versus dual averages, ensemble averages, 
and selected mid-value measurements. The Euler angles are computed for 
each IMU using the reported quaternion data (derived from the platform to 
outer roll gimbal resolver angles), the two fixed rotations which relate outer 
roll to the Nav base and the latter to the bo(fy reference system, and finally, 
the respective REFSMAT matrix which nominally orients each IMU with 
respect to the M50 system. An ordered sequence (-z, -y, -x) is assumed. 

in. 3. 2 File interfaces 

a. Input file 

The previously discussed JSC/TRW T/M tape provides the in- 
put data for ABSATT. The last three files are obtained as TAPES, TAPES, 
and TAPEIO to read in the quaternion data from IMUl, IMU2, and IMU3, 
respectively. Figure 18 depicts the necessary JCL to enable the proper input 
file manipulation and execute ABSATT as well. 

b. Output fil e 

Only a single output file, TAPE12, is generated. This file, in 
standard TIFT format, contains all possible differences generated and serves 
as input to the QUIKPLT utility. 
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m. 3.3 User Inputs 


NAME LIST /INPT/ permits minimal user control. Input variables are 
defined as: 


NAME 

Im 

Dimension 

Definition 

Units 

Default 

TTOL 

Real 

1 

Time tolerance to as- 
sure all IMU data valid 
at same time. 

seconds 

.1 

TOLN 

Real 

1 

Criterion for non- 
orthonormality detection 
of quaternions and pos- 
sible rejection 

N/A 

.00001 

TSTART 

Real 

1 

Start time for generation 
of differences 

seconds 

0.0 

TEND 

Real 

1 

Stop time for above file 
generation 

seconds 

1. E8 

TEPOCH 

Real 

1 

Epoch (reference) time 
desired, i.e., , time 
treated as zero from 
TEPOCH 

seconds 

0.0 

NR 

Integer 

1 

Number of records 
printed to hardcopy 
output 

N/A 

25 

RE FI 

Real 

(3,3) 

M50 to platform 
rotation matrix for 
IMUl 

N/A 

none 

REF2 

Real 

(3,3) 

As above except for 
IMU2 

N/A 

none 

REF3 

Real 

(3,3) 

As above except for 
IMU3 

N/A 

none 

RNBTORl 

Real 

(3,3) 

Nav base to outer roll 
rotation matrix for 
IMUl 

N/A 

none 

RNBTOR2 

Real 

(3,3) 

As above except for 
IMU2 

N/A 

none 

RNBTOR3 

Real 

(3,3) 

As above except for 
IMU3 

N/A 

none 

RNBTB 

Real 

(3,3) 

Nav base to body 

N/A 

none 


rotation matrix 
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in. 3. 4 Outputs 


The most significant output of ABSATT are the QUIKPLTs which 
display the various comparisons as Euler angle differences. Hardcopy output 
is minimal and includes, for the first NP points, printout of the computed Euler 
angles, averages, midvalues, and number of consecutive times each IMU was 
selected as the mid-value. A summary of the mid-value selection results, i.e. , 
by Euler angle component for each IMU, is printed as are the difference sta- 
tistics (mean, a ) for the file generated. 
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/ JOb 


/NOSEQ 

PREATT,T1000.CM200000. 


USER.274885C. 

UET.ABSATT. 

I•IN,I = ABSATT,R. 
VSN,TAPE80=NNO;33. 

LABEL, TAPE80, NT. D=PE.F=I.PO=R.R. 
C0PYBR.TAPE80.DUH.3. 
C0PYBR.TAPE80, TAPES. 
C0PYBR,TAPE80,TAPE9. 
COPYBR,TAPE80,TAPE10. 

REMIND, TAPE80. TAPES, TAPE?, TAPE10 
RETURN. TAPE80. 

UNLOAD, TAPE80. 
LDSET.PRESETA=INDEF. 

LGO. 

REMIND. TAPE12. 
GET,QUIKPLT/UN=149H1C. 
CALL,QUIKPLT(TAPE1=TAPE12) 
REMIND, SAVPLT. 

PL0T.CALP0ST.11(XH=0.5.YH=0.5) 

DAYFILE,PCGOOD. 

REPLACE, PCGOQD. 






EXIT. 


BIN63rtC MCCONNELL 

ORIGINAL PAGE 15 
OF POOR QUALITY 


Obtains last three{3) files 
of JSC/TRW telemetry data 
as TAPE8(IMU1), TAPE9 
(IMU2), TAPEIO (IMU3), 
respectively. 


Plots Euler angle 
differences 


DAYFILE.PCGOOF. 

REPLACE, PCGODF. 

/EOR 
$INPT 

TSTART=0..TEP0CH=.904920371807E7, TEND=1 .E11 , 

REF1 (1 .1 )=-. 79266172. -.44474863. .41699673, 

REF1 (1 ,2)=-.57519790..77226827,-.26971874, 

REF1 (1 .3)=-.20207602.-.45365167.-.86796603. 

REF2(1 ,1 >=.39075335, .73866644, .04925762, 

REF2(1 .2)=-.88816900,.45929717..01 417890, 

REF2( 1 .3)=-.24179873,-.49337438..83553258, 

REF3(1 ,1)=-.1 1996 126..22795183,-. 96625435. 

REF3< 1 .2 >=-.55783236.. 78963381 , .25553983, 

REF3(1 ,3) =.821 23822. .56966257. .03243346, 

RNBT0R1 (1 .1 )=.99999938,3.9528871E-4,1 .0380260E-3, 
RNBTOR1 (1 ,2>=-3.9528892E-4,.99?99992,0.. 

RNBIURI (1 ,3>=-1 . 0380259E-3, -4.1 0320 19E-7, .99999946. 
RNBT0R2(1 .1 >=.9999979.-1 .9876E-3.5.693E-4, 

RNBT0R2(1 ,2> = 1.9876E-3,. 9999980, 7, 5E-6. 

RNBT0R2(1 .3)=-5.693E-4.-6.3E-6,.9999998, 

RNBT0R3(1 ,1 >=.9999934,-3.7771 382E -3.3. 9459304E-4, 
RNBT0R3(1 ,2> =3. 7771 341 E-3, .99999338.1 .1723317E-5. 
RNBT0R3(1 ,3>---3.9463471E-4.-1 . 0690797E-5 . 1 . . 

RNBTBd ,1 >=.98293535,0.,. 183951 35, 
RNBTB(1,2)=0.,1.,0., ^ 

RNBTBd ,3 >=-.183951 35,0.,. 98293535, 
tEND 
/EOR 
/EOF 

EOI ENCOUNTERED. 




User 

inrHits 


/ 


Figure 18 Sample JCL to execute ABSATT 
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m.4 CALIBRT 


III. 4. 1 Functional description 

Software CALIBRT (Appendix D) estimates preliminary IMU In- 
stri'iment parameters using the model as discussed in Section n. 4. Twelve(12) 
parameters are estimated per IMU. The input file of "pseudo" observations is 
that file (TAPEll) generated by PREVEL (see Figure 19 for sample JCL). 
Calibrations computed are relative parameters since the selected observables 
represent an aibitraiy choice of IMU. Any particular IMU cpmblnations 

thereof (e.g. , averages or mid-value selects) can serve as the source for 
relative calibrations. Selected M50 data are rotated to each platform axis and 
compared versus said platform actual measurements to derive the individual 
platform calibrations. A least squares algorithm is employed. 

rtl. 4. 2 File interfaces 
(a) Input file 

The input file of observations is generated by PREVEL and 
read into CALIBRT as TAPES. Contained thereon are time-ordered measure- 
ments from each of the IMU's, dual and ensemble averages, and selected mid- 
values. Each record is written as; 


12 3 4 



AVG. 1 & 3 AVG. 2 & 3 ENSEMBLE MID- VALUES 

AVG 


Any of the eight(8) triplets cau be selected by user input for processing. 


3Ut files 


Three(3) output files are generated. TAPE9 contains the first 
pass residuals. The final residuals, based on applying the determined 
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calibrations, are written as TAPEIO. Both are written in TIFT format to 
utilize QUIKPLT. The third file, TAPEll, contains information for an auxil- 
iary solve routine, ESOLVE, which is not documented as yet. This file con- 

T 

tains the 36 x 36 normal matrix E A^ Aj , assembled from the vectors of 

partials of the observables with respect to the solution parameters as well as 

T 

the right-hand-side vector, r Aj Ay^ » where the Ay^ are the observational 
residuals. 


in. 4. 3 User inputs 

A namelist input is incorporated. Input parameters for NAMELIST/ 
INPT/ are: 


NAME 

Type 

Dimension 

Description 

Units 

Default 

RE FI 

Real 

3,3 

IMUl REFSMAT 

N/A 

NONE 

REF2 

Real 

3,3 

IMU2 REFSMAT 

N/A 

NONE 

REFS 

Real 

3,3 

IMU3 REFSMAT 

N/A 

NONE 

JCHOOSE 

Integer 

1 

Index to select desired 
set of triplets as obser- 
vables, (1,2,... 8) 

N/A 

NONE 

TSTART 

Real 

1 

Start time 

seconds 

0. 

TEND 

Real 

1 

Stop time 

seconds 

1.E8 

PP 

Real 

36 

Initial parameter 
estimates 

See 

NOTE 

below 

set to 
noiainals : 
i. e. , all 
zeros except 
scale factor 
terms 


NOTE: Units must correspond to model as described in 

Sef n n. 4 - Scale factors unitless, misalignment 
angles and drifts in rad/sec, and accelerometer 
biases in ft/sec^. 


The correspondence between the parameters in the PP array and the 
model parameters is as follows: 


PP array 


Model parameter 


1 

2 

3 

4 

5 

6 

7 

8 
9 

10 

11 

12 



IMUl 


13 

14 

15 

16 

17 

18 

19 

20 
21 
22 

23 

24 



s 

y 



b 

y 


6 

Z 

b 

z 


IMU2 
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PP array 


Model Parameter 


25 

s 

26 

-0, 

27 

-6, 

28 

5, 

29 

6 

30 

b 

31 

8 

32 

-6. 

33 


34 

b 

35 

s^ 

36 

b 


z 


IMU3 


J 


m. 4.4 Outputs 

Output generated includes: 

(1) a summary of the initial parameter estimates 


(2) total sum of squares, root mean square, and individual statistics 

( ^ , a) for each of the e:qpanded nine observables based on the initial 

parameter values; 

T 

(3) (A WA) ; 

(4) updates to the stimates of the instrument parameters; 

(5) predicted total sum of squares and predicted RMSQ; 

T 

(6) covariance (A W A ) in normalized form to show correlations; 

(7) revised parameters (including updates) and associated Ic uncertainties; 
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ORIGINAL PAGE IS 
OF POOR QUALITY 


/jot 

/NOSEQ 

EI1N63I1 MCCONNELL 


Obtain file of observables as 
generated by PREVEL 


Save results for ESOLVE 


Plot initial and final pass residuals 


DAIF ILE.CALGOOIi. 

I'iEPLACL.CALGOOIi. 

EXIT. 

LiArPJLE.CALEAli. 

KtPLACL.CALbAD. 

/EOK 

IINPI 

Ktf I ^ ■./VL661.'L', - ,'44474863. .416V96/J.- . j/b 1 9790 . . 771'768L'7 . 

2697 1 874 , 20207602 . -. 4E36*j 167. -.86796603, 
kEF2=.3907533‘j. . 7386664 4 , ,E4?2!.762.-. 8831 6900,. 4692971 7. 

.01 4 17690. -.241 79873. -.49337438. .83563253. 

KEF 3^ -.11 9961 26.. 22795 183. -.966254 35. -.55783236., 78963381 . 

,25553983. .82123822. .56966257. .03243346, 

JCH00SE=7, 

SEND 

/EOK 

/EOF 

EOI ENCOUNTEKEO. 

/ 


User inputs 


JCAL3RT, 12500, CM150000. 
USER.274885C. 

CHARGE, «Mi,LRC. 
GET,CALIBRT. 

FTN.I=CALIBRT,R. 

VSN.TAPE80=NY1016. 

LABEL ,IAPE80,NT .Ii = PE.F = I .FO^R 
C0KYEI.TAF'E80,TAF'E3. 
REUINII.TAF'EBO, FAPE8. 

RETURN, I APE80. 

IJNL0AU.TAPE80. 

ATTACHIF INMLIB/iJN^LIBRARY) 

LIiSET(PRtSETA=lNDEF,LIB=FTNHL 

LGO. 

REUIND,TAPE11. 

REPLACE, TAPEt1=EINPUT. 
REUINH,TAPE9,TAPE10. 

GEI ,QU1KPLI/UN:^149141C. 
L'ALL,0UIKPLT(TAPE1=TAPE10) 
REUINIKSAVPLI,TAPE2) 
LALL.QUIKPLI(IAPE1=IAPE9) 




,R. 


IB) 


} 


Figure 19 Sample JCL to execute CALIBRT 
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APPENDIX A 


Software Listir^ of PRETM 


PRETd 


original pa 
OF POOP Q'^*' 


urv 


PROGRAM F'RETM( INPUT, OUTPUT, TAPE5=INP'Jr.TAPE6 = 0UTPUT, 
*TAPE8.TAPE9.TAPE10) 

C FiRT LEVEL S/U FOR AMA.INC. TO REFORMAT JSC T/M DATA 
C INPUT FILE (TAPESiFROM SDC/LARC IN TIFT FORMAT 
C TAPES REORDERED UITH JCL AS Q,V FROM IMUS 1 ,2, 3. RESPECTIVELY 
C TAPES CREATED FROM JSC UNIVAC TAPE RE JSC/TRU ICD 
C TAPE? IS REFORMATTED OUTPUT FILE FOR PRFIMU 
C TAPE11 IS SHORT SUMMARY FILE FOR INFO BACK AT THE RANCH 

COMMON/FYLE/ TRAY ( 3000. 7 ) . DRAY ( 3000 .7 ) ,NN ( 7 ) . TQ ( 3000 ) . MM .LI ,L2. 
*TST ART. TEND, TOLN.TOLV.T OLD. TOLV)(.NDX(AOO. 7.3) .DOT .TBIASS 
DIMENSION ALPA(100).UNIT(100),HEAD(14).DAT(100) 

DIMENSION DSAV(6) .FRST(6).EDIT(9).EDYES(9) 

DATA FRST/6*0.0/,DSAV/6^t0.0/,BLNK/2H /,ASTR/2H + ^i/,EDN0T/1H /. 
+EDIT/9HH /.EDYES/1H1 .1H2,1H3,1H4.1H5.1H6.1H7.1H8.1H9/.D0Y/0./. 
HBIASS/0./ 

DATA NDX/8A00t0/ 

DATA NN/7*OV.TQ/3000:tO.O/, DRAY/21 000+0,0/. TRAY/2 1000^0.07, 
+TSTART/0.0/. TEND/1. E8/ 

DATA TOLN/. 00001 /,T0LQ/1 .0/,TOLV/100.0/,TOLT/1 .5/.T0LVX/1 .£10/ 
DATA L1/0/,L2/0/,MM/0/,N/0/ 

C 

NAM£LIST/INPT/TOLN,TOLQ,TOLV.TSTART,TEND,TOLVX,NDX,DOY.TBIASS 

r 

READ(5,INPT) 

C 

CALL COMMENT 
REWIND 8 
REWIND 9 
GO TO 6 
3 CONTINUE 

:F(IS.GT.3)G0 TO 6 

I PREIMU FILE 

IMU=IS 

CALL FILWRTdMU' 

DO 66 I = 1 , 6 
DSAV(I)=0.0 
66 CONTINUE 
6 CONTINUE 
N=0 
MMM=0 

C HEADER RECORD 

READ(8)IS,NUDS.(ALPA(I).I=1 ,NUDS) , (UNIT (I ) , 1=1 .NUDSI.HEAD 
IF(E0F(8) )1 ,2 
2 CONTINUE 

WRITEdO, 1 000) 15. NWDS 

WRITE! 10,1001 ) (ALPA(I),I=1 ,NUDS) 

URI TE( 10,1 002 )( UNIT ( I ), 1= 1 , NWDS) 

WRITEdO. 1 003)(HEAD(I), 1 = 1, H) 


A-1 


ORIGINAL PAGE IS 
OF POOR QUALITY 


iJKirE(6,ioooas,NUiis 
URITE(6,1001 )(ALPA(I),I^1 ,NUDG) 
URITE(6.1002)(UNIT(I) .1=1 ,RUDS) 
URITE(6.1003)(HEAD(I) .1 = 1 ,H) 

LIN = 5 

IF(NUDS.EQ.6)URITE(6.2050) 
IF(NUDS.EQ.5)URITE(6,2051 ) 

LIN=LIN+3 
5 CONTINUE 

c read data records 

READ(8)(DAT(1),I=1 ,NUDS) 

IF(E0F(8))3.A 
A CONTINUE 
N = N+1 

r SELECT DATA INTERVAL 

IF(DATm.LT.TSTART)GO TO 5 

IF(DAT(1 ).GT.TEND)G0 TO 5 

DATd )=DAT(1 )-D0Y:f86400. + TBIASS 

check sense OF QUATERNIONS 

IF(NUDS.EQ.5)G0 TO 49 

QTST=DAT(4) + DSAV(4)+IiAT(5)+IiBAV(5)+IiAT(6)»IiSAV(6) 

IF(QTST.GE.O.O)GO TO 44 

L2^L2+1 

IiO 45 1 = 1,4 

DAT(I + 2) = -1 .O^iDAT(I+2) 

45 CONTINUE 
44 CONTINUE 
MM=MM+1 
TQ(MM)=DAT(1 ) 

49 CONTINUE 

IF(HMrt.GT.1 )G0 TO 7 
no 9 I=3,NUDS 
nSAV(I)=DAT(I) 

? CONTINUE 
TSriV = DAT(1 ) 

7 CONTINUE 

C INITIALIZE EHITOR 

no 10 1=1,9 
EniT(I)=EDNOT 
10 CONTINUE 

nEL.T=DAT(1 )-TSAV 
GAF’=BLNK 

IF(DELT.GT.TOLT)GAF' = ASTR 
no 8 i=3,Nuns 
FRST(I)=IiAT(I)-nSAV(I) 
nSAV(I)=DAT(I) 

8 CONTINUE 
TSAV=DAT(1 } 

IF(NUDS.EQ.5)G0 TO 12 
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-PRE-EDIT UUATERNIONS 


c- 

L 

QN0R« = SQRT(DAT(3)^n24DAT(4)*f-2+DAT(5)+-^2+DAT(6)+*2) 
QTST=1 .O-ONORM 

IF(ABS(QTST).GT. T0LN)EDIT(5)=EDYES(5) 

DO 13 J=1,4 
IED=0 

IF(ABS(FRST(J+2) ).GT.TOLQ)EDIT(J)=EDYES(J) 

IF(ED1T(J) .NE.EDNOT.ANIi.EDIKS) .NE.EHNOT)IED=1 

E ---TEST FOR TIME( INDEX IREJECTION 

no 134 K=1 ,400 
IttU=IS-3 

IF(NDX(K,J,IMU) .EQ.NIGO TO 135 

134 CONTINUE 
GO TO 136 

135 EL'IT(J + 5)=EDYES( J + 5) 

GO TO 133 

136 CONTINUE 
IFdED.EQ.I )G0 TO 133 
NN( J)-NN(J)+1 
TRAY(NN(J),J)=DAT(I) 

DRAY(NN(J) ,J)=DAT(J+2) 

133 CONTINUE 
13 CONTINUE 
GO TO 14 
12 CONTINUE 
C 

PRE-EDIT OELOCITY COMPONENTS 

C 

DO 15 J=1,3 

IF (ABS(DAT(J + 2)) .GT.TOLOX)EDIT(J)=EDYES(J) 

IF(EIiIT(J) .EO.EDYE&(J))GO TO 155 
C NO NEED TO UR11E OR FURTHER TEST OBVIOUS BLUNDER POINTS 
IED = 0 

IF(ABS(FRST(J + 2) ) . 6T . TOL V )EDIT (J ) =EDYES ( J ) 

IF(EDIT(J) .NE.EDN0T.AND.GAP.EQ.BLNK)IED=1 

C ---TEST FOR TIME(INDEX)REJECTION 

DO 150 K=1 .400 

IF(NDX(K,J+4,IS) .EQ.N)GO TO 151 

150 CONTINUE 
GO TO 152 

151 CONTINUE 
EDIT(J+5)=EDYES(J+5) 

GO TO 155 

152 CONTINUE 
IFdED.EQ.I )G0 TO 155 
NN(J+4)=NN( J+4)+1 
TRAY(NN(J+4), J+4)=DAT(1 ) 

DRAY(NN(J+4),J+4)=DAT(J+2) 

155 CONTINUE 
15 CONTINUE 
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M LUNIINUt 

If- (MMh.EQ.1 )U:-;1TE( 10.1004) 

IRMMM.LT.II )URITE(10,1005)(DAT(I),I = 1 ,NUDS) 
IF(NUIiS.EQ.6)URITE(6,1050)(DAT(I),I = 1 ,NUDS) ,N. GAP, CELT . 

*(FRST(I),I = 3,NUHS) , (EDIT(I) ,1 = 1 ,9) 
IF(NUDS.EQ.5)URITE(6.1051)(r'AT(I),I=1 . NUDS ) , N . GAP, DELT . 

MFRST(I),I = 3.NUIiS),(EDIT(I).I = 1.9) 

L1N=L1N+1 

IPGE=0 

IF(h0I)(LIN,45).EQ.0)IPGE=1 
IF(IPGE.EQ.0)G0 TO 11 
IF(NUHS.EQ.6)URITE(6,2050) 

IF(NUIiS.EQ.5)URITE(6,2051 ) 

LIN = 3 

11 CONTINUE 
GO TO 5 
1 CONTINUE 
ENIIFILE 9 
REUINIi 9 

1000 F0RMAT(1H1,T20,"TS = " 14. 1 OX , "NUIlS = "14) 

1001 F0RMAT(T20,"ALPA = "8A10) 

1002 F0RMAT(T20,"UNIT = "8A10) 

1003 F0R(1AT(T20,"HEAH = "10A10) 

1004 F0RMAT(T30," FIRST 10 RECORDS PER FILE") 

1003 FORMAT(T2,6E20.14) 

1050 F0RMAT(1X,F9.2,F4.1 ,4E1 3.6, 2X , 14 , 1 X . A2. 1 X .5E 1 0 . 3 . 2X .9A1 ) 

1051 F0RNAT(1X,F9.2,F4.1 ,3E1 3. 6 , 2X , 14. 1 X . A2 . 1 X . 4i-'1 0 . 3 . 2X . 9A1 ) 

2050 F0RrtAT(1H1/T4,"TIHE",T1 1 . "FLAG" , T20, "0 1 1 ) " . T33 . "Q (2) " . 
*T46,"Qi3)",159,"Q(4)".T68,"NREC", T73. "GAP" . T80 . "DELT " . 

*T88."UEL 0(1 )".T98."DEL Q (2) " . T1 08 . "DEL Q ( 3 ) " . T i 1 8 . "DEL 0(4)". 
*T129,"EDIT"/) 

2051 F0RMAT(1H1/T4,"TIHE",T1 1 ."FLAG",T22."VX".T35."0r. 

*T48, "VZ",T55,"NREC",T60, "GAP", T67, "DELT". 

*T76,"DEL VX",T86,"DEL VY",T96,"DEL OZ" . T1 06 . "EDIT"/ ) 

END 

COHrtENT 

SUBROUTINE COMMENT 
C 

COMMON/FTLE/ TRAY ( 3000, 7 ), DRAY ( 3000,7 ) ,NN( 7) , TO ( 3000 ) ,MM ,L 1 ,L2 . 

< TST ART. TEND, TOLN. TOLU, TOLQ,TOLOX.HDX (400, 7,3) ,DOY.TBI ASS 
C 

DIMENSION YLAB(3),XLAB(7) 

DATA XLAB/8HQ(1 ), N=.8HQ(2), N=.8HQ(3). N=.8HQ(4). N=. 

+8H0ELX, N=,8HyELY. N=,8HVELZ. N=/ 

DATA YLAB/6HIMU(1 ) .6HIMU(2) .6HIMU(3)/ 

URITE(6,4000) 

4000 FORMATdHI ,///T20."PRETM PREPROCESSES JSC/TRU T/M TAPE AND PERFORM 
♦S SOME EDITTING"//) 

URITE(6,4001 ) 

4001 F0RMAT(T20,"TAPE 8 IS THE INPUT TAPE UIA JSC/TRU/LARC/SDC IN TIFT 
♦FORMAT") 
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URITE(6.4003) 

4003 f 0KrlAT(T25."SIX(6) ULLb IF ALL THREE IflU S ARE AVAILABLE") 
URnEl6,4002) 

4002 FORMAT (T20. "TAPE? IS REFORMAlIEIi INPUT TAPE FOR FRElflU, THREE FILES 
* ",/T25,"IF ALL THREE IMU MEASUREMENTS ARE BEING PROCESSED") 
URITE(6,4004) 

4004 F0RMAT(//T35,"EDIT KEYS ARE AS FOLLOUS'7, 

♦T20,"r',T4C."1ST COMPONENT (0(1) OR VZ) EXCEEDS TOLERANCE" /, 

*T20,"2",T40,"2ND COMPONENT (0(2) OR VY) EXCEEDS TOLERANCE"/, 

♦T20,"3",T40,"3RD COMPONENT (0(3) OR VZ) EXCEEDS TOLERANCE"/, 

*T2C,"4",T40,"4TH COMPONENT (0(4)) EXCEEDS TOLERANCE"/, 

+T20,"S",T40,"0UATERNI0NS ARE NOT ORTHOGONAL"/, 

H20."6".T40."1ST COMPONENT (0(1) OR VX) REJECTED BY INPUT"/, 

*T20,"7",T40."2ND COMPONENT (0(2) OR VY) REJECTED BY INPUT"/, 

*T20."8",T40,"3RD COMPONENT (0(3) OR VZ) REJECTED BY INPUT"/, 

+T20,"9",T40,"4TH COMPONENT (0(4)) REJECTED BY INPUT"/) 

URITE(6,4005) 

4005 F0RMAT(T35, "NAMELIST INPUTS IDENTIFIED TO DATE ARE:"/) 
URITE(6,4006) 

4006 F0RMAT(T20,"TOLT",T40,"TIME TOLERANCE FOR GAP DETERMINATION"/, 
+T20,"T0LV",140,"1ST DIFF VELOCITY TOLERANCE TO DETECT BAD DATA"/, 
+T20,"T0LVX",T40. "TOTAL VELOCITY TOLERANCE TO DETECI BAD DATA"/, 
+]20."T0LQ".T40."1S1 DIFF QUATERNION TOLERANCE TO DETECT BAD DATA"/ 
^.T20."T0LN".T40, "ORTHOGONALITY TOLERANCE"/, 

U20,"TSTART".T40. "START TIME FOR FILE URITE FOR PREIMU"/. 

•+T20, "TEND", T40, "FINAL TIME FOR FILE URITE FOR PREIMU"/, 
*T20,"NDX",T40, "ARRAY OF INTEGERS TO REJECT DATA ON INPUT"/, 
+T42,"ANY NDX(J, MEASUREMENT, IMU)=N REJECTS DATA"/, 

+T42."UHERE: J IS INPUT EQUAL TO INDEX ON INPUT FILETTAPE 8)"/, 
tI49, "MEASUREMENT IS 1-7 FOR Q(1 )-VZ, RESPECTIVELY"/. 
tT49."IMU IS EITHER T.2 OR 3 FOR THE DESIRED IMU") 

URITE(6,5000) 

URITEdO.5000) 

5C00 F0RMATUH1 .140." INPUT DATA SUMMARY "//) 

URITE(6,5001 )TSTART,TEND 
URITE(10,5001 )TSTART.TEND 

5001 F0RMAT(T20. "PREIMU FILE TO BE URITTEN BETUEEN ",F15.4," AND ", 
+F15.4." SECONDS") 

URITE(6,5002)T0LV,T0LVX.TOLJ,TOLN 
URITE( 10,50C2)TDLV.T0LVX.T0LQ,TULN 

5002 F0RMAT(/T43. "INPUT EDIT TOLERANCES ARE-"/, 

+ T25."1ST DIFF VEL" ,T40, "TOTAL VEL" , T55 . "1 ST DIFF QUAT", 

■d/O, "ORTHOGONALITY"/, 

d25.E10.4.T40.E10.4,T55,E10.4,T70,E10.4/) 

URITE(6,6001 )DOY,TBIASS 
UKITE(10,6001 )DOY,TBIASS 

6001 FORMAT(T20,"DAY OF YEAR EXTRACTED FROM TIME ="F8.2," TIME BIAS ADD 
♦ED = "F10.4/) 

C DETERMINE SELECTED DELETIONS BASED ON INPUT INDEX ARRAY 
URITE(6.5004) 

URITE(10,5004) 
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LOO'1 h0RhAn/I50,"SELEUEIi HAIA rjELETHrV ) 

N0NE=^0 

no t 1^1,3 

DO 2 J=1,; 

DO 3 K=1,400 
NFiCh--NDX(K,J,I) 

IF (NPICK.EQ.O)GO TO 5 
UR1TE(6.5003)YLAD(I) ,XLAB( J) ,NF'ICK 
URITE(10,5003)YLAB(1) ,XLAB(J),NPICK 
NONE=NONE+l 
5 CONTINUE 
3 CONTINUE 
2 CONTINUE 
1 CONTINUE 

5003 F0RMAT(T45,A6.T56.A8,I5) 

IF(N0NE.EQ.0)URITE(6,5005) 

IF(NONE.EQ.O)URITE( 10,5005) 

5005 F0RMAT(T57,"N0NE") 

RETURN 

END 

FILURT 

SUBROUTINE FILURT(IS) 

L 

COMMON/FYLE/ TRA Y ( 3000 , 7 ) , DRAY ( 3000, 7 ) , NN ( 7 ) , TO ( 3000 ) , f1« , L 1 , L2 
nSTART,TEND,T0LN,T0LV,TOLQ,T0LVX,NnX';40O,7,3).D0r.TBIASS 
C 

Nl^NNd ) 

N2=NN(2) 

N3=NN(3) 

N4=NN\4) 

N j- NN ( 5 ) 

N6 'NN ( 6 ) 

N.^^NN(7) 

WH1TE(9)IS,N1 ,(TRAY(1 .1 ), DRAY (1.1 ) ,1^1 ,N1 ) 

UKI rE(9)IS,N2, (TRAY(1,2).DRAY(I,2) .1=1 .N2) 
URITE(9)IS.N3,(TRAY(I .3) .HRAY(I,3) .1=1 ,N3) 

URITE(9)IS.N4, (TRAY(I,4) .HRAY(I.4).I=1 ,N4) 

URITE(9)IS,N5, (TRAYd.S) .DRAYd'S) .1 = 1 ,N5) 

URITE(9)IS,N6. (TRAY (1.6 ).DRAY (1.6). 1=1 ,N6) 

URnE(9)IS,N7, (TRAY(I,7) ,DRAY(I,7) ,1 = 1 ,N7) 

UR1TE(9)«M, (TQd) ,1 = 1 ,MM) 

Q URJJE PREIMU FILE SUMMARIES 

URITE(6,3000)IS 
URITEdO, 3000) 15 

3000 F0RMAT(1H1///////,T20,"F1LE HAS BEEN URITTEN FOR IMU #",12//) 
URITE(6,3001 )N1 ,N2,N3,N4,N5,N6,N7,MM 
URITEdO. 3001 )N1,N2,N3,N4,N5.N6,N7,MM 


3001 F0RMAT(T20, 

"THERE 

ARE 

"16," 

POINTS 

IN 

0(1 ) 

ARRAY"/, 

* T20, 

"THERE 

ARE 

"16," 

POINTS 

IN 

0(2) 

ARRAY"/, 

♦ T20, 

"THERE 

ARE 

"16," 

POINTS 

IN 

0(3) 

ARRAY"/, 

* T20, 

"THERE 

ARE 

"16," 

POINTS 

IN 

0(4) 

ARRAY"/, 
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I I20,"IHEKE ARE "16, " PUINIb IN MA ARRAr"/, 

* [20, "THERE ARE "16," P0IN13 IN OY ARRAY"/, 

' 120, "THERE ARE "16," POINTS IN VZ ARRAY"/, 

+ T20, "THERE ARE '16." POINTS ON OUAT . REF . TIME ARRAY"//) 

URITE(6,3002)TRAY(1,1 ).TRAY(N1 .1) 

URITE(6,3003)TRAY(1 ,2),TRAY(N2,2) 

URI IE (6,3004) TRAY ( 1 ,3),TRAY(N3, 3) 

URITE(6,3005) TRAY ( I , 4 ) , TRAY (N4 , 4 ) 

URITE(6,3006) IRAY( 1 .5) ,TRAY(N5,5) 

URITE(6.3007)TRAY(1 ,6),TRAY(N6.6) 
UR1TE(6,3008)TRAY(1,7),TRAY(N?,7) 

URI TE ( 1 0, 3002 ) TRAY (1, 1 ), TRAY (N1.D 
URITE( 10,3003)TRAYM ,2), TRAY(N2.2) 

URITE( 10,3004)TRAY(1 ,3), TRAY(N3.3) 

URITE( 10,3005)TRAY(1,4}. TRAY(N4,4) 

URITE (10,3006) TRAY M .5),TRAY(N5, 5) 

URnE( 10,3007)TRAY(1 .6),TRAY(N6,6) 

URITE( 10.3008)TRAY(1 .7). TRAY(N7.7) 

URITE(6.3009)TQ(1 ) ,T0(f1M) 

URITE(10.3009)TQ(1),TQ(MM) 

URITE(6,3010)L1 ,L2 
WRITE(10.3010)L1 ,L2 

3010 F0RMAT(//T20, "QUATERNIONS FLIPPED ",I6," TIMES BASED ON SIGN Q(1) 
*"/,T20. "QUATERNIONS FLIPPED ".16," TIMES BASED ON 2ND TEST") 


3002 

FORMAT( 120.' 

■Q( 1 ) 

ARRAY 

GOES 

FROM 

"F15.4," 

TO 

"F1S.4." 

SECONDS" 

) 

3003 

F0RMAT(T20.' 

'0(2) 

ARRAY 

GOES 

FROM 

"F15.4." 

TO 

"Fl'0.4." 

SECUNDS" 

) 

3004 

F0RMAT(T20,' 

■Q(3) 

ARRAY 

GOES 

FROM 

"FIS, 4." 

fO 

"FI 5. 4," 

SECONDS" 

) 

3005 

F0RMAT(T20.' 

'0(4) 

ARRAY 

GOES 

FROM 

"F15.4," 

TO 

"FI 5. 4." 

SECONDS" 

/) 


3006 F0RMAT(T20,"VX ARRAY GOES FROM "F15.4," TO "F'15.4," SECONDS") 

3007 F0RMAT(T20,"0Y ARRAY GOES FROM "F15.4," TO "F15.4." SECONDS") 

3008 F0RMAT(T20,"VZ ARRAY GOES FROM "F15.4," TO "F15.4." SECONDS") 

3009 F0RMAT(T20, "REFERENCE TIME ARRAY FOR QUATERNIONS IS BETUEEN". 

+F15.4." AND "F15.4." SECONDS") 

ENDFILE 9 
NN( 1 )=0 
NN(2)=0 
NN(3)=0 
NN(4)^0 
NN( j)=0 
NN(6)=0 
NN(7)^0 
L1=0 
L2 = 0 
MM = 0 
RE I URN 
END 

EOI ENCOUNTERED. 

/ 
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APPENDIX B 
Software Listing of 


PREVEL 


PROGRAM PREVEL(INPU7,OUTPUT.TAPE5^INPUT,IAPE6=OUTF’UT, TAPES, 

. TAPE?, TAPE10. TAPED. TAPE12) 

C PREPROCESSOR FOR FUTURE S/U THAT UILL HETERMINE CALIBRATION 
C COEFFICIENTS FOR THE VARIOUS IMU S 

C INPUT FOR THIS PROGRAM IS JSC T/M DATA. 

C TAPES CONTAINS VELOCITIES IN MSO COMPONENTS FOR IMl^ tl1 ; 

C IAPE9, FOR IMU «2; TAPE10, FOR IMU #3. (THIS IS ACCOMPLlSHEIi 
C THROUGH jn .) 

C AN OBSERVABLES FILE IS CREATED ( TAPE D ) UHICH WILL BE USED AS 
C INPUT FOR IMU CALIBRATION. THIS FILE CONTAINS 
C RECORDS OF 25 UORDS EACH. UHICH INCLUDE THE VELOCITIES IN 

C M50 COMPONENTS FOR EACH IMU AND VARIOUS COMBINATIONS OF THESE 

C VELOCITIES. 

C DIFFERENCES ARE WRITTEN TO TAPE12 FOR PLOTTING PURPOSES 
C (QUIKPLT IS UTILIZED HERE) 

C 

REAL MIDVALU(3) ,MEAN(76) 

LOGICAL COMBACK 

C 

DIMENSION I'.AT(5,3).V12AVG(3),V13AVG(3) .V23AVG(3),VT0TAVG(3) 
DIMENSION ICOUNT(3.3),KK(3),KPREV(3),KCOUNT(3).FIRST(3,3) 
DIMENSION ALPHA(77),UNITS(77) ,HEADER(8).RESID(76) 

DIMENSION SSQ(76) ,T0TAL(76).SIGMA(76) .DSAV(3.3),VIiIFF(3.3) 
DIMENSION UNTS(25),ALPA(25).HEADER2(8) 

C 

DATA IS/1/ 

DATA NUDS/77/ 

DATA ALPHA/ 

.■4HTIME.5HVX1-2.5HVY1-2.5HV21-2.5HVXl-3.5HVY1-3,5HVZl-3. 
.10HVX1-AVG2.3.10HVY1-AVG2.3,10HVZ1-AVG2,3.10HVX1-10TAVG, 
.10HVY1-T0TAVG, 10HVZ1-T0TAVG,10HVX1-MIDVAL,10HVY1-MIDVAL, 
.10HVZ1 -MIDVAL.5HVX2-3.5HVY2-3.5HVZ2-3,10HVX2-AVG1 ,3. 

. 10HVY2-AVG1 .3.10HVZ2-AVG1 ,3,1OHVX2-TOTAVG.10HVY2-TOTAVG, 
.10HVZ2-]OTAVG.10HVX2-MIDVAL,10HVY2-MIDVAL.10HVZ2-MIDVAL. 
.10HVX3-AVG1 .2.10HVY3-AVG1 ,2,10HVZ3-AVG1 ,2.10HVX3-T0TAVG, 
.l0HVY3-TOTAVG.1OHVZ3-TOTAVG,1OHVX3-MIDVAL.1OHVY3-MIDVAL. 
.10HVZ3-M1DVAL.10HVXAVG1 ,2-T , 1 OHVYAVG1 ,2-T , 1 OHVZAVG1 ,2-T, 
.10HVXAVG1 ,2-M.lOHVYAVGl ,2-M.10HVZAVG1 ,2-M.IOHVXAVGl ,3-T, 
.10HVYAVG1 ,3-T, 10HVZAVG1 ,3-T,10HVXAVG1 ,3-M.IOHVYAVGI .3-M, 
.10HVZAVG1 ,3-M,10HVXAVG2,3-T,1OHVYAVG2.3-T.IOHV2AVG2.3-T. 
.10HVXAVG2,3-M,10HVYAVG2,3-M,10HVZAVG2,3-M.9HVXTOT-MID, 
.9HVYTOT-MID,9HVZTOT-MID.7 HV‘iAG1-2.7HVMAG1 -3. 

.10HVM1-AVG2.3. 10HVMt-TOTAVG.10HVMl-MIDVAL,7HVMAG2-3, 
.10HVM2-AVG1 .3.10HVM2-T0TAVG.10HVM2-MIDVAL.1OHVM3-AVG1 .2, 
.10HVM3-T0TAVG.10HVM3-MIDVAL,1OHVMAVG1 ,2-T,10HVMAVG1 ,2-M. 
.10HVMAVG1,3-T.10HVMAVG1.3-M,10HVMAVG2,3-T,10HVMAVG2,3-M. 
.9HVMT0T-MID/ 

DATA UNITS/ 
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ORIGINAL PAGE IS 
OF POOR QUALITY 


. JHSFC..'6^6HH/btC7 

DhIA HthliLK'/U'HIflU VS. ln.?HU VS. ]t1U.6HH / 

[lAFA NUUHS/2S/ 

t'AlA UNIS/3HSEL.24i6Hn/SEC/ 

DAIA HEADER2/10HOtSERVABLE,10HS PLOTIEB ,6»1H / 

HA I A ALPA/ 

.4HI IflL.JHVXl .JHVY1 .3HV21 . JHVX2 . 3HVY 2 . 3HVZ2 , 3HVX3 , 3hVT 3 ,3HVZ3 . 
.7HV12AV()X.7HV12AVGY.7HV12AVGZ.7HV13AVGX,7HV13AVGY.7HV13AVGZ. 
.7HV23AVGX,7HV23AVGY.7HV23AVGZ.8HVI0TAVGX,8HVT0TAVGY,8HVT0TAVGZ, 
.8HMIDVALUX,8HMIHVALUY .BHMIDVALUZ/ 

C 

DATA TT0L/.1/ 

DATA VT0L/1.E10/ 

DATA DVT0L/1.E2/ 

DATA C1MBACK/. FALSE./ 

DATA T.TART/O.O/.TEND/t .E8/.TEP0CH/0.0/ 

DATA KPREV/3tO/ 

L 

NAf1ELlST/lNF'l/TT0L,VICL,DV[0L.T3TART.T£ND. [EPOCH 
L 

READlS.INPT ) 

URITE(6.INP1 I 
REUIND 8 
RE U I HD V 
RE U I HD 10 
HCOUNI ^ 0 
C 

C DUMMY READ'S TO SKIP OVER HEADER 

C 

READ(8) 

REAIK9) 

RE Aim 0) 


L URITE HEADER FOR DIFFERENCE TAPE (TIF FORMAT) 

C ALSO FOR OBSERVABLES FILE 


URITE ( 12) I S.NUDS, ALPHA. UNITS, HEADER 
URITE( 1 1 ) IS.N0UDS.ALPA.UNTS.HEADER2 
C 
C 

C INIIIALIZE COUNTERS 

C 

DO 20 1=1,3 
DO 20 J=1.3 

ICOUNT(I.J) = 0 
20 CONTINUE 
DO 2S 1=1.76 
SSQ(I) = 0. 
lOTAL(I) = 0. 

2‘j CONTINUE 
j CONTINUE 
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c 

c 

c 


RLAD IN DATA 


1 READ(8) (liAT(I.1).I = 1,5) 

IF(E0F(8)) 100,6 

6 CONTINUE 
C 

C SELECT DATA INTERVAL 

IF(DAT(1.1).LT.TSTART) GO TO 1 
IF(DAT(l.n.GT.TEND) GO TO 1 
IF(COrlDACK) GO TO V 

2 REAU19) (DAI (1.2) .1 = 1 .5) 
lF(EOF(y)) 100.7 

7 CONTINUE 
IF(CONBACK) GO 10 V 

3 READ(IO) (DAT( 1.3) .1=1 ,S) 

IF(EOFdO)) 100.8 

8 CONTINUE 
C 

INSURE TIrlE DIFFERENCES FOR EACH INTERVAL FOR EACH 

C IflU uitHIN SPECIFIED TOLERANCE. TTOL 

C 

9 CONTINUE 

DIFF12 = DATd.l) - DAT(1.2) 

DIFF13 = DATd ,1 ) - DATd ,3) 

D1FF23 = DAT( 1 ,2) - DATd ,3) 

COMBACK = .TRUE. 

IF(ABS(DIFF12) .LE.TTOL) GO TO 10 
IF(DIFF12,GT.O. ) GO TO 2 
GO TO 1 

10 CONTINUE 

1F(ABS(DIFF13). LE.TTOL) GO TO 11 
IFdUFF 13.GT .0. ) GO TO 3 
GO 10 1 

11 CONTINUE 

IF(ABS(D1FF23). LE.TTOL) GO TO 12 
IF(D1FF23.GT.0.) GO TO 3 
GO 10 2 

12 CONTINUE 
COMBACK = .FALSE. 

C 

C TEST FOR VELOCITY COMPONENT REJECTION 

C 

DO 15 1=1,3 
DO 15 J=3.5 

IF(ABS(DAT(J,I) ).GT.VTOL) GO TO 1 
15 CONTINUE 

NCOUNT = NCOUNT ♦ 1 


C SAVE INITIAL VELOCITIY COMPONENTS UHICH UILL BE SUBTRACTED FROM 

C EACH COMPONENT FOR MEANINGFUL COMPARISONS 
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ALSU CHLLK liELTA V S lU btt If I HL Y EXLELD 


U (NL0UNT.NE.1 ) 60 TO i8 
DO 35 1=1,3 
DO 35 J=1.3 

FIRSKJ,!) = DAT(J + 2.I) 

DSAO(J.I) = DAT(J+2,I) 

35 CONTINUE 
38 CONTINUE 
DO 45 1 = 1 .3 
DO 45 J=1 .3 

VDIFFU.I) = DAT(J + 2.I) - DStVU.l) 

DSAU(J.I) = DAT(J+2.I) 

IF (ADS'VDIFF(J.I)).G1.DUT0L) GO TO 43 
GO TO 44 

43 NCOUNT = NCOUNT - 1 
GO TO 1 

44 CONTINUE 

DAT(J^2.I) = DAT(J+2.I) - FIRST(J.I) 

45 CONTINUE 
L 

C POkn AKIIH.AOEKAGLS FOR ALL POSSIBLE PAIRS OP IrtU 

COflPORENIS AND AVERAGE PUR ALL 3 IflU'S 

C--(bUBSLRIPl I WILL BE RESPECTIVELY X. Y, OR Z COfIPONENT) 

DO 30 1=1.3 
J = I + 2 

DAT (1.1) = DATd .1) - TEPOCH 
V12AVG(I) = (UAl (J.l ) + DAT(J.2))/2. 

V13AVG(I) = (DAT(J.l) + DAT(J.3))/2. 

V23AVG(I) = (DAT(J.2) + DAT{J.3))/2. 

VTOTAVG(I) = (DAT(J.l) + DATiJ.2) + DAT(J.3))/3. 

C 

C PIND hIDVALUE OF ALL 3 IMU COflPUNENTS 

If (DAKJ.l ) .EO.DAT ( J.2) ) GO TO 32 
If (DAI ( J. 1 » .EO.DAl ( J.3) ) GO 10 32 
If ( DAI U.2) .EQ.DAl ( J.3) ) GO TO 34 
GO TO 17 
32 K = 1 

GO 10 18 
34 K = 2 

GO TO 18 

17 CONTINUE 

X«IN = Af1INl(DAI(J.l).DAT(J.2).DAI(J.3)) 

XMAX = AMAXl (DAK J.l ),DATU,2),DAT(J.3) ) 

DO 16 L=1 .3 
K = L 

IF ((DAT(J,L).NE.X«IH).AND.(DAI(J,L).NE.XNAX)) GO TO 18 
16 CONTINUE 

18 rtlDVALU(I) = DAT(J.K) 

ICOUNT(l.K) = ICOUNT(I.K) ♦ 1 

Kf',( ] ) = K 


i 
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If oaaD.Nt.l'CRtVd)) kluunud -- o 
IP(KK(l).tP.KfKEy(I) ) KCOUNMI) = KCOUNKI) + I 
Kf'REV(I) ^ KK(I) 

30 CONTINUE 
C 
C 

^ COMPUTE MAGNITUDES OF ALL 3-UECTOR OBSERVABLES 

C 

VMAG1 = S0RT(IiAT(3.1 )*»2 + DAT(4. 1)^+2 + DAT ( 5 . 1 ) 

VHAG2 = S0RT(DAT(3.2)M2 + DAT(4,2)**2 ♦ DAT ( 5 . 2) **2) 

VMAG3 ^ SQRT(HAT(3.3)»»2 + IiAT(^.3)+*2 + DAT(5.3)**2) 

VMAVG12 = SQRI(V12AVG(1 )M2 + V12AVJ(2)v»2 ♦ V12AVG(3)**2) 
'JMAVG13 ^ SQRT(V13AVG(1 )ii2 ♦ V13AVG(2d»2 + V13AVG(3M*2) 
VMAVG23 ■ bORT(V23AVG(1 4 U23AVG(2)4»2 + V23AVG ( 3 ) **2 ) 
VfllUIAV - SQRKVTOTAVGd )**2 + V lOT hVG ( 2 ) * >2 + VTO T AVG ( 3 ) > » 2 ) 
VMMIDVA = SQRT(MIDVftLU( 1 )40 + MI DVALU( 2 ) * *2 + MI nVALU ( 3 ) m 2 ) 

C 

C PIRSI 10 UR SO RECORDS ONTO OUTPUt FILE TO CHECK 

VALIDIIY OF CODE 

C 

IF (NCOUn.GI.lC) GO lU 40 
UkITE(6.1040) 

UKnE(6.104GJ 

URITE(6.10G0) (DATvl .I).I.(DAT(J,I).J=3,C).I = 1 .3) 

URITE(6.1060) (V12AVG(I,'.I = 1 .3) 

URI1E(6.1070) (V13AVG;I ) .1=1 ,3) 

URiTE(6,1080) (U23AVG(I ) .1=1 .3) 

URI1E(6,1090) (VTDIAVG(1),1=1,3) 

UR!TE(6,10?2) (KK ( 1 ) .KCOUNT ( i ) . 1= 1 .3) 

URITE(6.1094) 

40 CONTINUE 

URITEdn DATd.l),( (DAI(I.J).I=3.C).J=1 . 3 ) . ( V 1 2AVG ( 1 ) . I = . .3). 

. ( VI 3AV6( I ) .1 = 1 .3) . ( V23AVG( I ) . I = 1 . 3 ) . ( V 1 0 1 AVG ( I ) . I = 1 . 3 ) . 

.(MIDVALU(I).I=1.3) 

L 

C FORM DIFFERENCES FOR kLOITING 

L 

DO 4/ 1=1.3 
J = I + 2 
DA11 = DAT( J.1 ) 

DAI2 = DAT(J.2) 

DAI3 = DAT(J,3) 

RESID(I) = DAd - DAT2 

RESIIKdO) = DAI1 - DA13 

RESIIH146) = DAT1 - V23AVG(I) 

RESID(I+9) = DAT1 - VTOTAVG(I) 

res::ki412) = dati - midvalu(I) 

RESIDd + IS) = DAT2 - DAT3 

RESIIKI418) = DAI2 - V13AVG(1) 

RESID(I421 ) = DAT2 - VTOTAVG(I) 

R£SID(l424) = DAT2 - MIDV LU(I) 
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KtSllKI+27) = HAT 3 - M12AVGU) 

RtSID(I + 30) = IiAr3 - vrorAVGd) 

RESID(I+33) = HA13 - MICVALUd) 

RESID(Id6) = yi2AVGd) - VTOTAyGd) 

RESID(I + 39) = V12AVGd) - HIDVALUd) 

RESIIKI+42) = V13AyG(I) - VTOTAVGd) 

RESIDd+45) = UUAVGd) - MIDVALUd) 

RFSID(I+48) = V23AVG(I) - VTOTAVGd) 

RESID(I + 5d = V23AVG(I) - hlDVALUd) 

RESIDd+54) = VTOTAVGd) - MIDVALUd) 

47 CONTINUE 

RESIIK58) = VMAGl - VMAG2 

RESIIK59) = UMAGI - VMAG3 

RESiri(60) = VMAG1 - VMAVG23 

RESID<61 ) = VHAG1 - VMTOTAV 

RE SID (62) = VMAG1 - VfIfllDUA 

F:ESIIK63) = VMAG2 - VMAG3 

RESinicA) = UMAG2 - VMAVG13 

RES1IK65) = VMAG2 - V.1TOTAV 

RESID(66)= VMA62 - VrlMIDyA 
RESIIK67) = VMAG3 - UHAVG’2 

RESID(63) = y«AG3 - yMTOTAV 

RESI:K65) = VMAG3 - VrtMIIiyA 

RESIIK70) = VMAyP12 - UHTOTAy 

RESID(71) = yrlAyG12 - VnMIDVA 

RESIIK72) = V«AyG13 - yMTOTAV 

RESID(73) = y(iAyG13 - yflMIDVA 

RESIIK74) = UhAVG23 - VflTOTAV 

R :ID(75) = VKA" '>3 - UfiMIDVA 

F:ESIH(76) = V - yUMIDVA 

WRITE (12) DA' ■: : , I ).(RESID(I),I = 1 .76) 

C COrtPUTATIONS NEEDED FOR MEAN AND STD-DEUIAdON 

DO 90 1-1 .76 

TGTAdI) = TOTALd) + RESIDd) 

SSQd) = S3Q(I) + RESID(I)+*2 
90 CONTINUE 
GO TO 5 
100 CONTINUE 
C 

C COMPUTE MEAN AND STD. DEVIATION FOR EACH DIFFERENCE 

DO 110 1 = 1 ,76 

MEANd) = TOTAKD/NCOUNT 

SIGMA(I) = SQRT((SSQ(I) - MEAN (I ) *TOTAL( I ) )/ (NCOUNT - D) 
110 CC dNUE 

yRIIi:(6.1 095) NCOUNT 
DO 50 1 = 1 ,3 

URITE(6.2000) I 
URITE(6.2010) ICOUNTd.I) 

URITE(6.2020) IC0UNT(2,I) 

URITE(6.2030) :C0UNT(3,I) 

50 CONTINUE 
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URI lt(6.2t)40) NIOUNI 
URHt(6.2045) 

URITE(6.2050) ( ALPHA ( I + 1 ) , MEAN < I ) , SIGMA ( I ) . 1= 1 .76) 

C 

C 

1040 FORMAT (1 HI /T4. "I IME%7 18, "TITLE '. T37, " VX",T54, " VY". T71 ,'‘0Z") 

1045 F0RMAT(1H+,T4," _".T18," _ ”.T37, .T54,"__",T71 , 

1050 F0RMAT(lX,F9.2,5X,"IMU",I2,6X,kl7.6/) 

1060 F0RMAT(15X,"AyG— 1MU1S2",3E17.6/) 

1070 F0RMAT(15X,"A0G — 1MUU3",3E17.6/; 

1080 FORMAr(15X,"AOG— IMU2S3",3E17.6/) 

1090 FDRMAT(15X. "TOTAL A0G",2X,3E17.6/) 

1092 F0RMAT(15X."Ml[i0ALUE",3X,T37.14."(" ,14,")".T54,I4,"(".I4,")", 

.T71 ,;4,"(".I4.")") 

1094 FORM i(T39, "(NUMBER IN PARENTHESIS iS NUMBER OF CONSECUTU'E TIMES 
. THIS IMU HAS BEEN SELECTED)") 

1095 FORMATdHI ."TOTAL NUMBER OF RECORDS URITTEN =",I8) 

2000 F0RMATnH0."IMUr‘.I1." CHOSEN AS MIDVALUE FOLLOUING KTIMES:") 

2010 FORMATdH ,T30,"X-IiIRECTI0N" J45.I4) 

2020 FORMATdH . T30 , " Y-DIRECT ION" .T45 . 14 ) 

2030 FORMATdH . T30 . "2-HIRECTION" .T45. 14 ) 

2040 FORMATdHI ,"N I4//T1 8, "DIFFERENCE" . T37 . "MEAN" , T54 . 

.“STD DE'v'IATION") 

2045 FORMA! (1H+.T18." ",T37." ".T54,"„_, "//) 

2050 FnRMAT(18X.A10.2F 17.10/') 

ENDrILE 11 
ENDFILE 12 
REUIND 3 
REUIND 9 
REUIND 10 
REUIND 11 
REUIND 12 
STOP 
END 

EOI ENCOUNTERED. 

/ 
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APPENDIX C 

Software Listing of ABSATT 



PROGRAM ABSATK INPUT, OUTPUT. TAPE5=1NPUT,TAPE(4 = 0UTPUT. TAPES, 
.TAPE9.TAPE10,TAPE12) 

C INPUT FOR THIS PROGRAM IS JSC T/M DATA. 

C TAPES CONTAINS QUATERNIONS IN M50 COMPONENTS FOR IMU #1; 

C TAPE?, FOR IMU #2; TAPE10, FOR IMU #3. (THIS IS ACCOMPLISHED 

C THROUGH JCL.) 

C PLATFORM TO BODY QUATERNIONS (EULER ANGLES) ARE CREATED. 

C A PLOT FILE IS C.^EATED ( TAPE! 2— TIF FORMAT) UHICH CONTAIiTS 
C DIFFERENCES OF COMBINATIONS OF THE EULER ANGLES. 

C 

REAL MIDVALU(3) ,MEAN(57) 

LOGICAL COMBACK 
C 

DIMENSION DAT(6,3).E12AUG(3).L13AUG(3),E23AVG(3) ,ETOTAUG(3) 
DIMENSION ICOUNT(3.3).KK(3),KPREU(3),KCOUNT(3).QCO(3) 
DIMENSION ALPHA(58) ,UNITS(58) ,HEADER(8),RESID(57) ,LL(3,3) 
DIMENSION Q(A) ,QV(4.3) .RPT0(3.3),R0TB(3,3) ,RPTB(3,3) 
DIMENSION RMf-0T0B(3,3) .E(4,3) ,SSQ'57) ,TOTAL(57) ,SIGMA(57) 

C 

COMMON /MAT/REF1(3,3) ,REF2(3,3),REF3(3,3) ,RNBTB(3,3) 
.,RNBTOR1 (3,3) ,RNBT0R2(3,3).RNBT0R3(3,3),REF(3,3) ,KNBT0R(3,3) 
C 
C 

DATA IS/1/ 

DATA NUDS/58/ 

DATA ALPHA/ 

.4HTIME,5HEX1-2,5HEY1-2,5HEZ1-2.5HEX1-3,5HEYl-3.5HEZ1-3, 
.10HEX1-AVG2,3,10HEY1-AVG2,3.10HEX1-AUG2.3,10HEX1-TOTAVG, 
.10HEY1-T0TAVG.10H£Z1-T0TAVG,10HEX1-MIHVAL.10HEY1-MIDVAL. 
.10HEZ1-MIDUAL.5HEX2-3.5HEY2-3,5HEZ2-3,10HEX2-AVG1 ,3, 
.10HEY2-AUG1 . 3 . 1 0HE22- AUG1 . 3 . 1 OHEX2-TOTAVG . 1 0HEY2-T0TAUG, 
.10HEZ2-T0TAUG,10HEX2-MIDVAL,10HEY2-MIDVAL,1OHEZ2-MIDVAL, 
.10HEX3-AVG1 .2.10HEY3-AUG1 .2, 1 0HEZ3-AVG1 .2, 10HEX3-T0TAVG. 
.10HEY3-T0TAVG,10HEZ3-T0TAUG,10HEX3-MIDUAL.1OHEY3-MIDVAL, 
.T0HEZ3-MIDUAL.10HEXAVG1 ,2-T,10HEYAUG1 ,2-T . 1 OHEZAVG1 ,2-T, 
.10HEXAUG1 ,2-M.10HEYAV6T,2'M,10HEZAVG1 . 2-M , 1 0HEXAUG1 ,3-T, 
.10HEYAUG1 .3-r.lOHEZAyG1 ,3-T.10HEXAVG1 ,3-M,10HEYAUG1 ,3-M, 
.10HEZAVG1 .3 n.10HEXAVG2,3-T,10HEYAVG2,3-T.10HEZAUG2,3-T, 
.10HEXAVG2,3-M,10HEYAVG2,3-M,10HEZAUG2,3-M,9HEXTOT-MID, 
.9HEYTOT-MID,9HEZTOT-MIIi/ 

DATA UNITS/ 

.3HSEC,57*7HDEGREES/ 

DATA HEADER/IOHIMU VS. IM,9HU VS. IMU , 1 0H ( EULER ANG,4HLES), 
.4*1H / 

C 


DATA TTOL/.1/ 
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DAIA VTOL/1 .tIO/ 

DATA TOLN/. 00001/ 

DATA COMDACK/. FALSE./ 

DATA TSTART/0. 0/. TEND/1 .E8/.TEPOCH/0.0/ 

DATA KF'REO/3 + 0/ 

DATA IF‘LAG/1/,QC0/3*0./, LL/9+0/ 

DATA N1/3/,N2/3/,N3/2/,N4/1/,N5/1/.N6/2/,F'I/3. 141 5926536/ 
DATA NR/25/ 

DATA NRES/57/ 

C 

NAMELIST/ INF'T/TTOL.OTOL, TOLN, TSTART, TEND, TEF'OCH, NR 

,REF1 .REF2.REF3,R,.tiT0R1 ,RNBTOR2,RNBTOR3,RNBTB 


CONO = 

180. /PI 

A2PI = 

2. + PI 

AHPI = 

.5+PI 

A3HPI = 

1 .5+PI 

ODDPI = 

25. -1 PI/1 8 

RE AIK 5, 

INPT) 

URITE(6 

,1NPT) 

REUIND 

8 

REUIND 

9 

REUIND 

10 

NCOUNT 

= 0 


C DUMMY READ'S TO SKIP OVER HEADER 

C 

READ (8) 

READC9) 

READdO) 

C 

C URITE HEADER FOR DIFFERENCE TAPE (TIFT FORMAT) 

C 

URITE (12) IS.NUDS, ALPHA, UNITS, HEADER 
C 
C 

C INITIALIZE COUNTERS 

C 

DO 20 1=1,3 
DO 20 J=1,3 

ICOUNT(I.J) = 0 
20 CONTINUE 

DO 25 I=1,NRES 
SSQ(I) = 0. 

TOTAL(I) = 0. 

25 CONTINUE 
5 CONTINUE 
C 

c read in data 

C 
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1 READ(8) (IiAT(I,n.I = 1,6) 
IF(ECF(8)) 100,6 

6 CONTINUE 
C 

C SELECT DATA INTERVAL 

IF(DAT(1,1).LT.TSTART) GO TO 1 
IFdiATd ,1) .GT.TEND) GO TO 1 
IF(COMBACK) GO TO 9 

2 REAIK9) (DAT(I,2),I = 1 ,6) 
IF(E0F(9)) 100.7 

7 CONTINUE 
IF(COHBACK) GO TO 9 

3 REAIK10) (UAT(I.3),I=1,6) 
IF(EOFdO)) 100.8 

8 CONTINUE 


C 

C INSURE TIME DIFFERENCES FOR EACH INTERVAL FOR EACH 

C IMU ARE UITHIN SF'ECIFIEU TOLERANCE . TTOL 

C 


9 CONTINUE 

U1FF12 = DATd,1) - DATd.2) 

UIFF13 = DATd.D - DATd.S) 

DIFF23 ^ DAT(1,2) - DATd,3) 

COMBACK = .TRUE. 

IF(ABS(DIFF12).LE.TT0L) GO TO 10 
IF(DIFF12.GT.O.) GO TO 2 
GO TO 1 

10 CONTINUE 

IF(ABS(IHFF13).LE.TT0L) GO TO 11 
IF(DIFF13.GT.0.) GO TO 3 
GO TO 1 

11 CONTINUE 

IF(AES(DIFF23).LE.TT0L) GO TO 12 
IF(DIFF23.G1 ,0.) GO TO 3 
GO TO 2 

12 CONTINUE 
COMBACK = .FALSE. 

C 

C TEST FOR ORTHOGONALITT REJECTION 

C 

DO 14 1 = 1 ,3 

QNORM = SQRT(DAT(3.I)**2 + DAT(4,I)*^»2 + LAT(5.I)*^»2 
.+ UAT(6,I)+*2) 

QTST = 1.0 - QNORM 
IF (ABS(QTST).GT.TOLN) GO TO 1 
14 CONTINUE 

NCOUNT = NCOIJNT + 1 
DO 13 1 = 1 ,3 
C 

C **■* OBTAIN THE M50 TO PLATFORM (CONSTANT) ROTATION MATRIX 
C *** FOR THIS IMU. 
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CALL GETrtAKI) 


C UBIAIN THE OUTER ROLL ro BOOT (CONSTANT) ROTATION MATRIX ROIB 

CALL ROT(ROTB) 

C ♦++ COMPUTE THE PLATFORM TO OUTER ROLL ROTATION MATRIX 
DO 70 J=1,4 
70 Q(J)=DAT(J+2,I) 

CALL QMAT(Q.RPTO) 

C ■*■** COMPUTE THE PLATFORM TO BODY ROTATION MATRIX 
DO 80 J=1.3 
DO 80 K=1,3 
RPTB(J,K)=0. 

DO 80 M=l,3 

80 RPTB(J.K)=RPTB(J,K)+ROTB(J.M)+RPTO(M,K) 

C +++ COMPUTE THE M50 TO BODY ROTATION MATRIX 
DO 90 J=1 ,3 
DO 90 K=1,3 
RM50T0B( J,K)^0. 

DO 90 M=1,3 

90 RM50T0B(J,f;)=RM50T0B(J.K)+RPTB(J,M)^tREF(M,K) 

C EXTRACT THE PLATFORM TO BODY EULER ANGLES AND STORE IN 00(1-3,1) 

QV(4.I)=ATAN2(-IFLAG*RM50T0B(N3,N2) .IFLAGtRM50TOB(3.3) ) 
ABV=ABS(QC0(I)-QV(4.I)) 

IF(ABV.GT.AHPI.AND,ABV.LT.A3HPI)IFLAG=-IFLAG 

QVd .I)=ATAN2(-IFLAGtRM50T0B(N3,N2) ,IFLAG+RM50T0B(3,3)) 

TEMP = RM50T0B(3,3)/C0S(QV(1 ,1) ) 

QO(2,I)=ATAN2(RM50TOB(N4,N1 ) .TEMP) 

QV(3, 1 )=ATAN2(-IFLAGtRM50T0B(N5.NA) , IFLAG^^RMGOTOB ( 1 , 1 ) ) 
QC0(I)^QV(1 .1) 

C +♦+ INSURE CONTINUITY OF THE EULER ANGLES THROUGH 360 DEGREES 
IF(NC0UNT .NE.l ) GO TO 77 
DO 76 J=1,3 
E(J,I) = QO(J.I) 

76 CONTINUE 

77 DO 13 0=1.3 

IF((E(J,I)-QO( J.I) ) .GT.ODDFI)LL( J,I)=LL(J, I) + 1 
IF ( (E( J.I)-OV( J.I) ) .LT.-ODDPI )LL(J,I)=LL(J.I)-1 
E(J.I)=QV(J.I) 

13 QV(J.I)=0y(J.I)+LL(J.I)*A2PI 
DO 15 1=1,3 
DO 15 0=1 ,3 

DAT(J+2.I) = QV(0,I)*C0N0 
15 CONTINUE 


C 

C FORM ARITH. AVERAGES FOR ALL POSSIBLE PAIRS OF IMU 

0 COMPONENTS AND AVERAGE FOR ALL 3 IMU'S 
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ORIGINAL PAGE IS 
OF POOR QUALITY 


C-'(SUBSCRIPT 1 dill BE KESPECflVELY X. Y. OR L tUril- ONEN I ) 

HU 30 1=1,3 
J = I + 2 

HAT(1,I) = DAT(1,I) - 7EPOCH 

E12AUG(I) = (DAT(J,1) + DAT(J,2))/2. 

E13AVG(I) = (DAT(J,1) + DAT(J.3))/2. 

E23AVG(I) = (l)AT(J.2) + IiATU,3))/2. 

ETOTAVG(I) = (DAT(J,1) + DAT(J,2) + DAT(J,3))/3. 

C 

C FIND MIDVALUE OF ALL 3 IMU COMPONENTS 

IF(DAT(J,1).EQ.DAT(J,2)) GO TO 32 
IF(DAT(J,1 ).EQ.DAT(J,3)) GO TO 32 
IF(DAT(J.2).EQ.DAT(J.3)) GO TO 3A 
GO TO 17 
32 K = 1 

GO 10 18 
34 K = 2 

GO TO 18 

17 CONTINUE 

XMIN = At1IN1(IiAT(JJ),DAT(J.2).HAT(J.3)) 

XMAX = AMAX1 (DAKJ.I ),HAT(J.2).DAT(J.3) ) 

DO 16 L=1,3 
K = L 

IF ((DAT(J.L).NE. XMIN). AND. (DAT(J.L).NE. XMAX)) GO TO 18 
16 CONTINUE 

18 MIDVALU(I) = DAT(J.K) 

ICDUNTd.K) = ICOUNT(I.K) + 1 
KK(I) = K 

IF(KK(I).NE.KPREV(D) KCOUNT(I) = 0 
IF(KK(I).EQ.KPREV(D) KCOUNT(I) = KCOUNT(l) + 1 
KPREVil) = KK(I) 

30 CONTINUE 
C 
C 


C 


C 

C 

C 

C 


c 


40 


URITE RECORDS 

URITE FIRST NR RECORDS ONTO OUTPUT FILE TO CHECK 
---VALIDITY OF CODE--- 


IF (NCOUNT.GT 
URITE(6.1040) 
URITE(6.1045) 
URITE(6,1050) 
URITE(6.1060) 
URITE(6,1070) 
URITE(6,1080) 
URITE(6.1090) 
URITE(6,1092) 
URITE(6,1094) 
CONTINUE 


NR) GO TO 40 


(IiAT(1.I),I.(DAT(J.I).J = 3,5),I = 1,3) 
(E12AVG(I) ,1=1 ,3) 

(E13AVG(I),I = 1 ,3) 

(E23AVG(I),I=1 ,3) 

(ET0TAVG(I),I=1,3) 

(KK(I),KC0UNT(I),I=1,3) 
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c -- 

L 


Ki‘<rl IiII-FERENC£S FOR FLOfllNU- 


nO 47 1=1,3 
J = I + 2 
DATl = IiAT(J,1) 

DAT2 = DAT(J,2) 

DAT3 = HAT(J,3) 

RESID(I) = DATl - DAT2 

RESID(I+3) = DATl - DAT3 

RESIIKI+6) = DATl - E23AVG(I) 

RESID(I+9) = DATl - ETOTAVG(I) 

RESID(I + 12) = DATl - HIDVALUd) 

RESIIKI+15) = DAT2 - DAT3 

RESIIKI + 18) = DAT2 - E13AVG(Il 

RESID(I+21 ) = DAT2 - ETOTAVG(I) 

RESID(I+24) = DAT2 - HIDVALU(I) 

RESID(l+27) = DAT3 - E12AyG(I) 

RESID(l+30) = DA73 - ETOTAVG(I) 

RESID(I+33) = DAT3 - HIDVALU(I) 

RESID(I+36) = E12AVG(1) - ETOTAVG(I) 

RESID(I+39) = E12AVG(I) - MIDVALU(I) 

RESID(I+42) = E13A0G(I) - ETOTAVG(I) 

RESIIidHG) = E13AVGd) - hIDVALUd) 

RESIDd+48) = E23AVG(I) - ETOTAVGd) 

RESIDd+51 = E23AVGd) - illDVALUd) 

RESIDd+54) = ETOTAVGd) - MIH'.'ALU ( I ) 

47 CONTINUE 

UR1TE(12) DAT(l,1),(RESIDd),I = 1,57) 

DO 95 I=1.NRES 

TOTALd) = TOTALd) + RESID(I) 

SSQd) = SSOd) + RESIDd)*i'2 
95 CONTINUE 
GO TO 5 
100 CONTINUE 
C 

C COMPUTE MEAN AND STD. DEVIATION FOR EACH DIFFERENCE- 

C 

X = FLOAT(NCOUNT) 

XM1 = FLOAT(NCOUNT - 1 ) 

DO 1 10 1=1 ,NRES 

MEANd) = TOTAL(I)/X 

SIGMAd) = SQRTdSSQd) - MEANd)*TOTAL(I ) )/Xi11 ) 
110 CONTINUE 

URITE(6,1095) NCOUNT 
DO 50 1=1,3 

URITE(6,2000) I 
URITE(6.2010) ICDUNTd,!) 

URITE(6,2020) IC0UNT(2,1) 

URITE(6.2030) IC0UNT(3,I) 

50 CONTINUE 

URITE(6.2040) NCOUNT 
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URI ft(6,204b; 

URIU(^.?050) « ALPHA (1 + 1 ) ,HL AN U ) . LIbfiA ( 1 ) . I = 1 . NRt S ) 

L 

C 

10A0 F0Rf1AT(1H1/TA,"TI(1E", n8."Il rLE",137."E(1 )",T54,"E(2)",T7) ,"E(3)") 

1045 FORMAT! 1H+J4," ",T18," ", T37, T54 , T71 .'_"/// ) 

1050 F0RMAT(1X,Fy.2,5X,"IMU",I2,6X,3E17.6/) 

1060 FORMAT! 15X,"AVG— IMU1i2",3E17.6/) 

1070 FORMAT! 15X,"AVG— IMU1*3",3E17.6/) 

1 060 FORMAT! 15X,"AVG--1MU2J13",3E17.6/) 

1090 FORMAT ! 15X, "TOTAL .iVG" ,2X , 3E1 7 . 6/ ) 

1092 F0RMAT!15X,"MIIiVALUE".3X.T37.I4,"!'M4,")".T54,I4,"!",H,")", 

.T71 ,I4,"!".I4,")") 

1094 F0RMAT!T39, "(NUMBER IN PARENTHESIS IS NUMBER OF CONSECUTIVE TIMES 
. THIS IMU HAS BEEN SELECTEID") 

1095 F0RMATUH1. "TOTAL NUMBER OF RECORDS URITTEN =".I3) 

2000 FnLnAT!1H0."IMUr.Il." CHOSEN AS MIDMALUE FOLLOUING MTIMES:") 

2010 FORMATdH . T'O . "X-DiRECT ION" . T 45. H ) 

2020 FORMATdH . T30 . "Y -DIRECT ION " . T45 , 1 4 ) 

2030 FORMATdH . T30 . "Z-DIRECT I ON" . T45 . 1 4 ) 

2040 FORMAT!! HI ."N = " . I4//T 1 8 . "DI FFERENCE" . T37 . "ME AN" . T54 . 

."STD DEVIATION") 

2045 F0RMAT!1H+.T18."^ . _ ",T37," . ".T54." . 

2050 F0RMATd8X.A10.2ri7.10/) 

ENDFILE 12 
REUIND 8 
REUIND 9 
REUIND 10 
REUIND 12 
STOP 
END 

SUBROUTINE GETMAT(N) 

COMMON/MAT/REFI (3.3 ).REF2! 3.3 ).REF 3(3,3 ) .RNBTB! 3.3) 

. .RNBT0R1 (3,3) .RNBTOR2!3.3).RNBTOR3!3.3).REF!3.3),RNBTOR!3.3) 

GO TO (1 0.20.30) ,N 
10 REF (1 .1 )=REF1 ! : .1 ) 

REF!2.1 )=REFd2. , ' 

REF!3.1 )^REF 1(3.1 ) 

REFd .2)=REF1 ( ( d' 

REF (2.2)=REF1 (2.2) 

REF!3.2)=REF1 (3.2) 

KEFd .3)=REF1 d .3) 

REF(2.3)=REF1 (2,3) 

REF(3.3)=REF1 (3.3) 

RNBTORd.l) = RNBTOR1!l,l) 

RNB10R!2.1)=RNBTOR1!2,1) 

RNBT0R(3.1 )=RNBT0R1 (3,1 ) 

RNBT0R(1.2)=RNBT0R1!1.2) 

RNBT0R!2.2)=RNBT0R1 (2,2) 
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RNBT0R(3,2)=f<NBf0ft1 (3,2) 
RNBTORd ,3)=RNinOR) U ,3) 
RNBT0R(2i3)^RNBT0Rl(2,3) 
RNBT0R(3,3)=RNBT0R1(3.3) 
GO TO 40 

20 REF(),1)=REF2d,1) 

REF(2,1 )=REF2(2,1 ) 
REF(3,1)=REF2(3,1 ) 
REF(l,2)=REF2n.2) 
REF(2,2)-REF2(2.2) 
REF(3,2)=REF2(3.2) 

REFd .3)=REF2(1 .3) 
REF(2.3)=REF2(2,3) 
KEF(3.3)=REF2(3,3) 

RNBT0Rd,l)=RNBT0R2d.l) 
RNBT0R(2.1)=RNBT0R2(2d) 
RNBT0R(3d )=RNBT0R2(3.1 ) 
RNBTORd ,2)=RNBT0R2d .2) 
RNBT0R(2,2)=RNBT0R2(2,2) 
RNBT0R(3,2)=RNBT0R2(3,2) 
RNBTORd ,3)=RNBT0R2d ,3) 
RNBT0R(2,3)=RNBT0R2(2,3) 
RNBT0R(3,3)=RNBT0R2(3.3) 
GO TO 40 

30 REFd .1 ) = REF3d .1 ) 
REF(2.1 )=REF3(2,n 
REF(3,1)=REF3^3.1) 

REFd .2) = REF3d .2) 
REF(2.2)=REF3(2.2) 

REF (3,2)=REF3(3,2) 

REF d .3)=REF3d .3) 

RLf i2.3)=REF3(2.3) 

REF (3,3)=REF3(3.3) 

RNBTORd d )=RNBT0R3d ,1 ) 
RNBT0R(2d )=RNBT0R3(2.1 ) 
RNBT0R(3d )=^RNBT0R3(3.n 
RNBTORd ,2)-RNtT0R3d .2) 
RNBT0R(2,2)=RNBF0R3(2.2) 
RNBT0R(3.2)=RNBT0R3(3.2) 
RNBTORd ,3)^RNBT0R3(1 .3) 
RNBT0R(2.3)=RNBT0R3(2,3) 
RNBT0R(3.3)=RNBT0R3(3.3) 


40 CONTINUE 
RETURN 
ENB 
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* 


SUbROUHNE ROf(A) 

DIMENSION ft(3,3) 

COMMON/M AT/KEFl i 3 . 3 ; . REF 2 ( 3 . 3 ) . REE 3 ( 3 . J ) .RNFT Bt 3 . 3 ) 

..RNRIORI (3.3) ,RNtIOR2(3,3),RNf<rOR3(3,3) .KEF(3.3).RNIiI0R(3,3) 

L A - OUTPUT OUTER RULE (0 bODY ROTATION r.FlRU 

L 'M RNBTB = NAV BASE TO BOUT ROTATION MATRIX (PAU-LUAID 
L RNBTOR = NAV BASE TO OUTER ROLL ROTATION MATRIX (UirFERENI 

C FOR EACH IMU (PAH LOAD)) 


DO 10 1=1,3 
DO 10 J=1,3 
A(I,J)=0. 

DO 10 K=1 .3 

10 A(I.J)=A(I,J)+RNBTB(I,K)tRNBTOR( J.K) 
RETURN 
END 

SUBROUTINE QMAKO.A) 

DIMENSION 0(4),A(3,3) 

L M+ Q z input quaternion 

C A = OUTPUT ROTATION MATRIX 

P2=Q(2)+0(2) 

P3=Q(3)+Q(3) 

P4=Q(4)+Q(4) 

P5=P2+0(2) 

P6=P4*Q(4; 

TEMP=1 .0-P3*Q(3) 

A( 1 , 1 )=TEMP-P6 
A(2,2)=1 .0-P5-P6 
A(3,3)=TEMP-P5 
PS=P2»Q(3) 

P6 = P4 + Q( 1 ) 

A(1.2)=PS-P6 
A (2.1 )=P5+P6 
P5=P2*Q(4) 

P6=P3»Q(1 ) 

Ad .3)=P5 + P6 
A(3. 1 )=PS-P6 
P5=P3*Q(4) 

P6=P2+Q(1 ) 

A(2,3)=P5-P6 

A(3,2)=P5+P6 

RETURN 

END 

EOI ENCOUNTERED. 

/ 
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APPENDIX D 


Listing of CALD’DT 


« 


» 


l-'ROGRAII LALIBRT (INPUT ,OU [PU f . lAPE^MNI'U T . ! All 6-OU IPUT . TAPE8 . 
.IAP£9.IAPE10,IAPE11) 

C S/U ID IITERHINE CALIBRATION PARAMETERS (E.G..SLAI.L TACfORS. 

C BIASES. niSALlGNMENlS) FOR THE VARIOUS IMIJ S U1II.17ING A 

C LEAST-SQUARES BATCH FILTER. 

C AN OBSERVABLES F ILE ( TAPES ) IS INPUT. IT IS A I Irtll-ORUERED 
C FILE OF VM50 DATA FROM EACH IMU AS WELL AS POSSIBLE 

C AVERAGE AND MIDVALUE SELECT MEASUREMENTS. 

C RESIDUALSCOBSERVABLES MINUS COMPUTED VALUES) ARE URIITEN TO 
C TAPE9(BEF0RE THE FIRST ITERATION) AND I APE 1 0 ( AE TERUARDS ) . 

C THE CUIKPLT ROUTINE IS UTILIZED FOR PlOITING. 

C IAPE11 (EINPUT) IS TO BE INPUT FOR LSOLVE ( GMK S). 

C 

C 

COMMON /SUM/SPTP(36.36).SPI T( J6) .PTP(36.J6) .PIT l36' 

C 

REAL MEAN(9) 

C 

DIMENSION SAPEXI(J6).XAPR(36) .XPREV(36).XTITLE(36) ,D(9) 
DIMENSION REFl (3.: ).REF2(3.3) .REF3(3.3) ,OBS( 9 ) . OBSDMSO( 3 ) 
DIMENSION OBSIN(:A),IPICK'8).CQVAR(36.3S).P(9.36).COMPOBS(V) 
DIMENSION UiV) .PPv 36) .A( 9.9) .PTPINV(36. 36) 

DIMENSION D Y ( 9 ) . I P I VOT ( 36 , UK ( 32 ) . I EMPK 36 . 36 ) . DPP ( 36 
DIMENSION LABC0V(5).LABPTPI(5),LABC(36) .ALPKA(IO) .UNI IS! 10' 
DIMENSION HEADERB(8).HEADERA(8) .SIGMA(9 ) .SSQ(?) .101 AL (9) 

C 

DATA IS/1/ 

DAIA NUfS/10/ 

DATA UNIIS/3HSEC.9*6HF f/SEL/ 

DATA HEADEKB/IOHOBSERVABLL.lOH - COMPUTE . 1 OHD ( BEFORE C. 
.10HALIBRATI0N.1H).3*1H / 

DATA HEADERA/IOHObSERVABLE.lOH - COMPUTE . 1 OHD ( AFIER CA. 

■ lOHLIBRATIONl.OIH / 

DATA ALPHA/4HTIME. 1 OH X0BS1 -COMP. lOH YOBS l-r;CMP.10HZ0Bb1-L0f1P. 

. 1 OHXOBS2-COMP. 10HYUBS2-C0MP, 10HZ0BS2-C0MP. 10HX0BS3-LOMF . 

. 10HY0BS3-C0MP.10HZ0BS3-C0MF7 
DATA DPP/36tO./ 

DATA I PlCK/1 .■1,7.10,1 3.16.19.22/ 

DATA PF71 . .‘j*0..1 . ,3>0..1 . ,0..1 . ,5*0.. 1 ..3*0. . 1 . . 0 . . 1 . . S* 0 . . 
.1..3«C.,1.,0./ 

DATA XPREV/1 . ,5*0. .1 . .3*0., 1 . ,0. . 1 . ,S*0. . 1 . . 3 *0. . 1 . . 0. . 1 . . S *0 

. 1 . ,3*0. ,1 . , 0./ 

DATA XAPR/1 ..5»0. ,1 ..3*0. ,1. ,0,, 1 . , S *0 . , 1 . . 3*0 . . 1 . .0..1 . ,S*0. 
. 1 . ,3*0. , 1 . .0./ 

DATA NTOlX/36/ 

DATA TSTARi/O./ 

DATA TEND/1. E8.' 
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DhIA SAPEX f/J6»0. 

DATA XT! FLE/3HSX1 .^HA121 .4HC121 .4HA13! ,4HC151 .3HBX1 .3HbY1 . 
.4HA23; .4HC231 .iHBYl .3HSZ1 .3HFZ1 .3HSX2, 4HA122.4HC122.4HA1 32. 
.4HC132.3HEIX2,3HSY2.4HA232,4HC232,3HB''2.3HSZ2,3H£22.3HSX3, 
.4HA12 j,4HC123.4HA133,4HC133,3HBX3,3HSY3.4HA233.4HC233,3HBY3, 
.3HSZ3,3HBZ3/ 

DATA LABPTPI/8HPTPIND =,4*1H / 

DATA LABC/5HC0L 1,5HC0L 2.5HC0L 3.5HC0L 4.5HCOL 5,5HC0L 6. 
.5HC0L 7,5HC0L 8.5HC0L 9.6HC0L 10.6HC0L 11.6HC0L 12.6HC0L 13. 
.6HC0L 14.6HC0L 15.6HC0L 16,6HCUL 17.<5HC0L 18.6HC0L 19, 

.6HC0L 20,6HC0L 21.6HC0L 22.3;HC0L 23.3HC0L 24,6HC0L 25, 

.6HC0L 26.6HC0L 27.6HC0L 28.6HC0L 29,6HC0L 30.6HC0L 31. 

.6HC0L 32.6HC0L 33.6HC0L 34.6HCDL 35.6HC0L 36/ 

DATA LABC0V/10HC0VARIANC£,2H =,3^MH / 

C 

C 

NAflELIST /INPf/REF1,r<EF2.REF3. JCH00SE.TSTARl .TEND.PP 
C 

READ(5.INPT) 

URITE(6.INPT) 

C 

C +++ URITE HEADERS FOR RESIDUAL PLOTS TAPIKTIF FORMAT) 

C 

URITE(9) I S.NUDS. ALPHA. UNITS. HE ADERB 
URITE(IO) IS.NUDS.ALPHA.UNITS.HEADEKA 

C 

ICOUNT ^ 0 
1 CUNTINUE 
C 

C SKIP OVER HEADER ON OBSERVABLES FILE 
C 

REUIND 8 
READ (8) 

1F(E0F(8) .NE.C) GO TO 500 
C 

»JCOUNT = 0 
no 20 I:=1.36 
DO 10 J=1 .36 

SPTP(I.J) = 0. 

10 CONiINUE 

SPTY(I) ^ 0. 

PP(I) = PP(I) > DPP(I) 

20 CONTINUE 

UR I IE (6,1050) (XT:TLE(I),PP(I ) .SAPEXT(IM = 1 .NTOTX) 

DO 30 1=1.9 
TOTAL(I) = 0. 

SSQ(I) = ). 

30 CONTINUE 
40 CONTINUE 
C 

C +++ READ IN DATA 
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REAIK8) flrtE.OBSIN 
IH (E0F(6) .NE.O) GO 10 GOO 
C SELECT DATA INTERNAL 

if(ti«e.lt.tstart) go to 40 
IF ( TIME. GT. TEND) GO TO GOO 
IF (EOF O) .NE.O) 60 TO 500 
NCDUNT = NCOUNT + I 
IF(NCOUNT.EQ.I) TINIT = TIME 
lAU = TIME - TINIT 

C +++ PICK A DESIRED SET OF MGO LATA 
ICHOOSE = IPICKUCHOOSE) 

DO GO J=1,3 

K = ICHOOSE - 1 + J 
OBSDMGO(J) = OBSTN(K) 

50 CONTINUE 
C 

C + + + ROTATE SELECTED MGO SET TO RESPECTIVE PLATFORM USING REF 1.2 CR 3 
C 

DO 60 1 = 1 .3 

OBS(I) = QBS(I+3) = 0tiS(I+6) = 0. 

0(1) = U(I+3) = U(I+6) = 0. 

DO 60 J=l,3 

QBS(I) = OIS(I) + REF1 (I,J)^f0BSDM50(J) 

U(I) = U(I) + REF1 (I . JMOBSINU) 

0BS(I + 3) = 0B3(I+3) + REF2(I .J)^»0BSDM5O(J) 

U(I+3) = l)(I + 3) + REF2(I. J)^rOB3INU + 3) 

0BS(I + 6) = 0B31I + 6) REF3(l,J)*0BSDM50lJ) 

0(1+6) = U(I+6) + REF3(I.J)*0BSIN(J+6) 

60 CONTINUE 
C 

C +++ FORM COMPUTED OBSERVABLES 
C 

DO 70 1=1.9 
DO 70 J=1.9 


A(L 

■J- 

; = 0. 

70 CONTINUE 


Ad .1 ) 

- 

ppd ) 

Ad. 2) 


-ipp(2) + PP(3)+TAU) 

Ad. 3) 


PP(4) + PP(5)*TA!I 

A (2,1 ) 

= 

-Ad ,2) 

A(2,2) 


PP(7) 

A(2.3) 

= 

-(PF'(8) + PP(9)*TAU) 

A(3.1 ) 

= 

-Ad 3) 

A(3,2) 

= 

-A(2 3) 

A(3.3) 

= 

P) V 11) 

A(4,4) 

= 

PPd3) 

A(4,5) 

- 

-(PP(14) + PPd5)+TAU) 

' A(4,6) 

r 

PP(16) + PP(17)»TAU 

A(5,4) 

= 

-A(4,5) 

A ( 5 • 5 ) 

- 

PP(19) 


I>-3 


• \ 


A ( J , 6 ; 

= (PP(20) 

4 

PP(21 M TAU) 

Al6,4) 

= -A (4, 6) 



A(6.5) 

= -A(5.6) 



A ( A , 6 ) 

= PP(23) 



A(7,7) 

= PP'25) 



A ( 7 . 8 ) 

= -(PP(26) 

+ 

PP(27)*TAU) 

A 1 7 . 9 

= PP(28) + 

PP(29)+TAU 

A ' 8 . : ) 

= -A(7.8) 



A ( 3 , 8 j 

= PP(31) 



A(8.9) 

= -(PP(32) 

+ 

PP(33)+TAU) 

A19,7) 

= -A(?,9) 



A(9.8) 

= -A(3.9) 



A(9,9) 

= PP(35) 



B(1 ) = 

PP(6) 



B(2) = 

PPdO) 



B(3) = 

PP(12) 



B(4) = 

PP(18) 



B(5) = 

PP(22) 



B(6) = 

PP(241 



B(7) = 

PP(30) 



b(b; = 

PPI34) 



B(9) = 

PP(3c ) 



BO 90 

1 = 1.9 




TEMP = 0. 


no 30 K=1 .9 

TEMP = TEMP + A(1.K)^»U(K) 

80 CONTINUE 

COMPDBS(I) = TEMP + EKD^TAU 
nr (I) = oB'S(i) - coiPOBS(i) 

90 CONTINUE 

IF (ICOUNT.EQ.O) URIT£(?) TIME . ( BY (I ) . 1^1 - 9 ) 
IFdCOUNT.EQ.n URITEdO) TIME . (BY ( I ) . 1 = 1 .9) 
BO 100 1 = 1 .9 

TOTAL(I) = rOTAL(I) + BY(I) 

SSQ(I) = SSO(I) + BY(I):t::d 
100 CONTINUE 


C 

C +++ FORM PARTIAL MATRIX 
C 


BO 110 1=1 ,9 


BO 110 

J = 

1 ,36 

P(I 

,J) 

= 0. 

CONTINUE 


Pd .1 ) 


P(2,2) = 

P(3,4) 

= 

-U(1 ) 

P ( 2 , 3 ; 

= 

TAU+lcd ) 

P(3.5) 


-P(2,3) 

Pd ,2) 

= 

-U(2) 

P(2,7) 

= 

P(3.8) = 

Pd .3) 

= 

-TAU*U(2) 


U(1 ) 


U(2) 
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f -i.?) ^ -I-M1.3) 

F'd .4) ^ P(3,11) ^ Ui3) 

P»2.8) = -UT3) 

F'(^ .5) = TAU^tU(3) 

F'(2,9) ^ -F'd ,5) 

F(1 .6) == F'(2.10) = F'(3,12) = TAU 


P •, 4 . 1 3 ) 

= 

PI5,14) = 

U(4) 

P ( 6 . 1 6 ) 


-W(4) 


P ( 5 . 1 5 ) 

= 

TAU1U14) 


F ( 6 . 1 7 ) 

- 

-F(5.15) 


F •; 4 . 1 4 ) 


-U(5) 


P ( 5 . 1 9 ) 


P16.20) = 

U(5) 

F ( 4 . 1 5 } 

= 

-TAU:»U(5) 


F(6.21 ) 

r 

-F14.15) 


P(4.16) 

= 

P16.23) = 

U(6) 

P(5.20) 

- 

-U(6) 


P ( 4 . 1 ? ) 


TAU+U(6) 


P(5.21 ) 

- 

-P(4,17) 


P(4.18) 

= 

P(5,22) = 

F(6. 

P(7,25) 

= 

Pi 8. 26) = 

U17) 

P(9.28) 

= 

-U(7) 


P(8.27) 

= 

TAU*U17) 


Pi 9. 29) 

- 

-FIS. 27) 


Pi ".26) 

- 

-U(8) 


P ( S , 3 1 ; 

' 

P(9,32) = 

L'(8) 

P(7.27) 


-TAU+U18) 


P19.33) 

- 

-F17.27) 


P(7,28) 


P(9,35) = 

U(9) 

P(8.32) 

= 

-U(9) 


P(7.29) 

= 

TAU»U(9) 


F(8.33) 

= 

-P17.29) 


P(7.30) 

- 

PI 8. 34) = 

P(9, 


C 

C +++ FORH NORMAL MATRIX AND RIGHT-HAND-SIDE VECTOR 
C 

DO 120 1=1.36 
DO 120 J=1.36 
PTP(I.J) = 0. 

DO 120 K=1 .9 

PTP(I.J) = PTP(I.J) + F■(K.I)^^F'(K. J) 

120 CONTINUE 

DO 130 1=1 ,36 
FTT(I) = 0. 

DO 130 J=1.9 

PTY(I) = FTY(I) + P(J,I)*IiY(J) 

130 CONTINUE 

CALL SUMS(NTOTX) 

C 

GO TO 40 
500 CONTINUE 
C 
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L 

L 


lllt-'UiL ilLAN. 3I6MA. lUIAL SSQ ANH RflSQ ^NOIt: UEIGHf 


= 1 ; 


I'j b Q = 0 • 

HO 1 i^j I-t .9 

rttAN(I) = fOIAUD/NCOUNr 

SIGrtA(I) = SQRT((SSQ(I) - (1LAN (I ) +TO [ AL ( I ) ) / ( NCOUNT - 1)) 
TSSQ = TSSQ+ SSQ(I) 

135 CONTINUE 

RMSQ SQRT(TSSQ/(9. ^NCOUNT) ) 

IF(ICOUNT.NE.O) GO TO 137 
MCOUNT = 9*NC0UNT 

URITEd 1 ) TST ART, TENII, 36. MCOUNT. TSSQ. RrtSQ 

WRITE (11) (XTITLE(I),XfREU(I),XAFR(I).SAF'EXT(I).I = 1.NTOH' 

URITEd 1) ((SPTP(I.J).J = 1,NTOTX).I^1 .NTOTX). 

. (SPTY(K) .K=1 .NTOTX) 

END FILE 11 
137 CONTINUE 

URITE(6.1030) TSSQ. RMSQ 

WRITE (6. 1070) (ALPHA (1 + 1 ) . MEAN ( I ) . SIGMA ( I ) .1^1.9) 

t 

HO HO 1 = 1 ,36 
DO 140 J=1 .36 

PIPINO(I.J) = SPTP(I.J) 

140 CONTINUE 

CALL MAriNV(36.36,PTPINO,0.TIiUM,O,IiE[ERM.ISCALE,IPIVOT.UI<) 
CALL PRIMAT(36.1 ,36,36, PTPINV.LAtPTPI.L ABC. 1 .0) 

C 

C 

C +++ SUM ENTRIES OF [PTP] TIMES ITS INVERSE TO CHECK RANK 
C 

SUM = 0. 

HO 150 1=1.36 
DO 150 J--1 .36 

TEMPI (I.J) = 0. 

DO 150 K=1 .36 

TEMPKl.J) = TEMPKI.J) + SFTP ( I , K ) + PT F INV ( K . J ) 

150 CONTINUE 

DO 160 1=1 .3o 
DO 160 J=1 ,36 

SUM = SUM + TEMPKI.J) 

160 CONTINUE 

URITE(6.1000) SUM 
URITE(6,1010) DETERM 
C 

C +++ SUM ENTRIES FOR NORMAL MATRIX AND RH'SIDE 
C 

LJ 170 1=1,36 
HPP(I) = 0. 

DO 170 J=1,36 

DFP(I) = DPP(I) + FTFINV(I.J)+3PTY( J) 

170 CONTINUE 


D-6 
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i 


y[;i iti6.io:;o 1 uri iLLU).LipF'a).i-i.iNiuix) 

C M+ COMPUTE PREUICTETI SSO.RMSG FOR COnT'ARlSON 
C 

IF (ICOUNT.NE.O) GO TO 17? 

TEMP 0. 

DO \?Z I=1,NT0TX 

TEMP = TEMP + SP7Y(I)*HPP(1) 

P5 CONTINUE 

PSOS = TSSQ - TEMP 
PRMSQ = SQRT\PS0S/(9.:xNC0UNT) ) 
yRlTE(6.1040) PSOS, PRMSQ 
GO TO 179 
177 CONTINUE 

DIFFSO = PSOS - TSSQ 
URITE(6.1060) DIFFSQ 

179 CONTINUE 
C 

C +++ NORMALIZE COVARIANCE 
C 

HO 185 1=1.36 
HO 180 J=1.36 

COVAR(I.J) = PTP1NV(I.J)/(SQRT(PTPINV(I.I))* 
SQRT(PTPINV(J.J?)) 

180 CONTINUE 

SAPEXT(I) = SQRKPIPINV(I.n) 

185 CONTINUE 

CALL PRIMAT(36,1 ,36,36. C0V;'.R,LAHC0V,LABC.1 ,0) 

C 

IFdCOUNT.GE.I ) GO TO 200 
ICOUNT = ICOUNT + 1 
GO TO 1 
C 
C 

1000 FQRMATdHI." THE SUM OF [PTP] TIMES ITS INVERSE I3".E12.5) 
1010 F0RMAT(1H0."THE HETERMINANT OF CSPTP] =".E12,5) 

1020 FORMATdHI ,5X." PARAMETER", 13X. "DELTA PP" // ( 9X , A1 0 . E20 , 1 2 ) ) 
1030 FORMATdHI ,5X, "TOTAL SUM OF SQUARES =".E20.12// 

.5X,"RMSa =".E20.12/) 

1040 FORMATdHI .5X."PREHICTEH TSSQ =".E20.12// 

.5X."PREHICTED RMSQ =",E20.12/) 

1050 FORMATdHI ,5X . "PARAMETER" .9X . "SOLUT ION" . 1 2X. "SIGMA"// 
.(9X.A10,2E20.12J) 

1060 F0RMAT(iH0,5X,"PREHICTEH - ACTUAL SOS =".E20.12) 

1070 FORMATdHI ,5X, "RESIDUAL". 13X, "MEAN". 13X, "SIGMA"// 
d9X,AlO,2E20.12)) 

C 


200 CONTINUE 
END FILE 9 
END FILE 10 
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I 


^'LL'inj a 
REUiNLi 9 
REUlNIi 10 
STOP 
END 

bUDROUTINE SUMS(NSOLV) 

COMflON /SUM/SPrF(36.36),SPTY(36).PTP(36.36).PTY(36) 

DO 20 1^1 .N30LV 
DO 10 J=1 ,NS(JLV 

SPIP(l.J) = SPTP(I.J) + PTP(l.J) 

10 CONTINUE 

SPTY(I) ^ SPTYm + PTY(I) 

20 CONTINUE 
RETURN 
END 

EOT ENCOUNTERED. 


